OPTIMAL  AUTONOMOUS  SPACECRAFT  RESILIENCY  MANEUVERS  USING 

METAHEURISTICS 

DISSERTATION 


Daniel  J.  Showalter,  Captain,  USAF 
AFIT-ENY-DS-14-S-29 


DEPARTMENT  OF  THE  AIR  FORCE 
AIR  UNIVERSITY 

AIR  FORCE  INSTITUTE  OF  TECHNOLOGY 


Wright-Patterson  Air  Force  Base,  Ohio 


DISTRIBUTION  STATEMENT  A: 

APPROVED  FOR  PUBEIC  REEEASE;  DISTRIBUTION  UNEIMITED 


The  views  expressed  in  this  dissertation  are  those  of  the  author  and  do  not  reflect  the  official 
policy  or  position  of  the  United  States  Air  Force,  the  Department  of  Defense,  or  the  United 
States  Government. 

This  material  is  declared  a  work  of  the  U.S.  Government  and  is  not  subject  to  copyright 
protection  in  the  United  States. 


AFIT-ENY-DS-14-S-29 


OPTIMAL  AUTONOMOUS  SPACECRAFT  RESILIENCY  MANEUVERS  USING 

METAHEURISTICS 


DISSERTATION 


Presented  to  the  Faculty 

Graduate  School  of  Engineering  and  Management 
Air  Force  Institute  of  Technology 
Air  University 

Air  Education  and  Training  Command 
in  Partial  Fulfillment  of  the  Requirements  for  the 
Degree  of  Doctoral  of  Science  in  Astronautical  Engineering 


Daniel  J.  Showalter,  BS,  MS 
Captain,  USAF 

September  2014 


DISTRIBUTION  STATEMENT  A: 

APPROVED  FOR  PUBLIC  RELEASE;  DISTRIBUTION  UNLIMITED 


AFIT-ENY-DS-14-S-29 


OPTIMAL  AUTONOMOUS  SPACECRAFT  RESILIENCY  MANEUVERS  USING 

METAHEURISTICS 


DISSERTATION 


Daniel  J.  Showalter,  BS,  MS 
Captain,  USAF 


Approved: 


/signed/  29  Jul  2014 

Jonathan  T.  Black,  PhD  (Chairman)  Date 

/signed/  29  Jul  2014 

Darryl  K.  Ahner,  PhD  (Member)  Date 

/signed/  29  Jul  2014 

Raymond  R.  Hill,  PhD  (Member)  Date 

/signed/  29  Jul  2014 

William  E.  Wiesel,  PhD  (Member)  Date 


Accepted: 


/signed/ 


15  Aug  2014 


A.B.  Badiru 

Dean,  Graduate  School  of  Engineering  and  Management 


Date 


AFIT-ENY-DS-14-S-29 


Abstract 


The  growing  congestion  in  space  has  increased  the  need  for  spacecraft  to  develop 
resilience  capabilities  in  response  to  natural  and  man-made  hazards.  Equipping  satellites 
with  increased  maneuvering  capability  has  the  potential  to  enhance  resilience  by  altering 
their  arrival  conditions  as  they  enter  potentially  hazardous  regions.  The  propellant 
expenditure  corresponding  to  increased  maneuverability  requires  these  maneuvers  be 
optimized  to  minimize  fuel  expenditure  and  to  the  extent  which  resiliency  can  be  preserved. 
This  research  introduces  maneuvers  to  enhance  resiliency  and  investigates  the  viability 
of  metaheuristics  to  enable  their  autonomous  optimization.  Techniques  are  developed  to 
optimize  impulsive  and  continuous-thrust  resiliency  maneuvers.  The  results  demonstrate 
that  impulsive  and  low-thrust  resiliency  maneuvers  require  only  meters  per  second  of  delta- 
velocity.  Additionally,  bi-level  evolutionary  algorithms  are  explored  in  the  optimization  of 
resiliency  maneuvers  which  require  a  maneuvering  spacecraft  to  perform  an  inspection 
of  one  of  several  target  satellites  while  en-route  to  geostationary  orbit.  The  methods 
developed  are  shown  to  consistently  produce  optimal  and  near-optimal  results  for  the 
problems  investigated  and  can  be  applied  to  future  classes  of  resiliency  maneuvers  yet  to 
be  defined.  Results  indicate  that  the  inspection  requires  an  increase  of  only  five  percent 
of  the  propellant  needed  to  transfer  from  low  Earth  orbit  to  geostationary  orbit.  The 
maneuvers  and  optimization  techniques  developed  throughout  this  dissertation  demonstrate 
the  viability  of  the  autonomous  optimization  of  spacecraft  resiliency  maneuvers  and  can  be 
utilized  to  optimize  future  classes  of  resiliency  maneuvers. 
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OPTIMAL  AUTONOMOUS  SPACECRAFT  RESILIENCY  MANEUVERS  USING 

METAHEURISTICS 


I.  Introduction 


1.1  Motivation 


The  United  States  has  long  enjoyed  a  competitive  advantage  over  the  rest  of  the  world 
in  the  space  domain.  As  a  result,  it  has  relied  heavily  on  space  capabilities  to  provide 
products  and  services  to  military  and  civilian  users. 

The  United  States’  asymmetric  advantage  in  space  has  decreased  in  recent  years  as 
more  countries  have  invested  in  space  capabilities.  In  addition,  the  space  environment  itself 
has  changed  from  an  uncontested  one  to  an  environment  in  which  access  to  and  the  use  of 
space  can  no  longer  be  taken  for  granted.  In  light  of  this  shifting  paradigm.  President 
Obama  released  an  updated  National  Space  Policy  (NSP)  in  2010  [1]  which  states  “The 
United  States  will  employ  a  variety  of  measures  to  help  assure  the  use  of  space  for  all 
responsible  parties,  and,  consistent  with  the  inherent  right  of  self-defense,  deter  others 
from  interference  and  attack,  defend  our  space  systems  and  contribute  to  the  defense  of 
allied  space  systems,  and,  if  deterrence  fails,  defeat  efforts  to  attack  them.” 

The  Department  of  Defense  (DoD)  released  its  National  Security  Space  Strategy 
(NSSS)  in  2011  in  response  to  the  guidance  specified  in  the  NSP.  One  of  the  key  tenets 
of  this  strategy  is  to  deter  attacks  on  U.S.  systems  by  denying  adversaries  the  benefits  of 
attacks  through  “cost-effective”  protection  and  resilience  [2]. 

Similarly,  the  2014  Quadrennial  Defense  Review  (QDR)  highlighted  the  need  to 
prepare  for  adversary  attempts  to  deny  current  U.S.  advantages  in  space  [3].  In  response 


1 


to  this  threat,  the  QDR  states  that  the  United  States  “will  move  toward  less  complex,  more 
affordable,  more  resilient  systems. ..to  deter  attacks  on  space  systems.” 

An  NSSS  supplemental  document  on  resilience  highlighted  four  basic  principles 
which  define  resilience:  avoidance,  robustness,  reconstitution,  and  recovery  [4].  The  NSSS 
supplement  defines  avoidance  as  “countermeasures  against  potential  adversaries,  proactive 
and  reactive  defensive  measures  taken  to  diminish  the  likelihood  and  consequence  of  hostile 
acts  or  adverse  conditions”  [4]. 

U.S  reliance  on  space  capabilities  for  military  operations  and  intelligence  [2]  and 
the  global  nature  of  space  systems  make  it  impossible  to  avoid  potentially  hostile  areas 
of  the  globe.  As  a  result,  resilience  through  avoidance  in  space  must  be  achieved  by 
preventing  the  occurrence  of  hostile  action.  One  way  to  prevent  hostile  action  is  to 
introduce  uncertainty  into  the  arrival  conditions  of  friendly  space  assets  when  they  overfly 
potentially  hazardous  geographic  regions  on  the  Earth.  This  uncertainty  can  be  achieved 
by  equipping  space  assets  with  enhanced  maneuvering  capability  which  would  allow  them 
to  modify  their  arrival  conditions  from  those  predicted  by  previous  observations  and  orbit 
prediction  algorithms. 

Increased  resiliency  through  satellite  maneuverability  comes  at  a  price,  however, 
specifically  in  terms  of  the  amount  of  propellant  required  to  achieve  it.  Increased 
maneuverability  requires  additional  propellant  for  a  given  mission,  which  in  turn  leads 
to  heavier  satellites  and  larger  launch  costs.  Currently,  it  costs  nearly  $10,000  per  pound  to 
place  a  satellite  into  Earth  orbit  [5].  As  a  result,  avoidance  maneuvers  should  be  optimized 
to  minimize  the  amount  of  propellant  consumed  during  their  execution  to  the  extent  which 
resiliency  can  be  preserved. 

Generating  optimal  spacecraft  trajectories  comes  with  its  own  cost  with  respect 
to  the  manpower  required  for  design  and  analysis.  One  way  to  address  the  long¬ 
term  manpower  costs  associated  with  maneuverability  is  to  introduce  autonomy  into  the 
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maneuver  optimization  process.  A  recent  DoD  Defense  Science  Board  (DSB)  study  on 
the  role  of  autonomy  states  that  increased  use  of  autonomy  in  space  systems  “has  the 
potential  to  enable  manpower  efficiencies  and  cost  reductions”  [6].  The  study  also  states 
that  increased  spacecraft  autonomy  can  make  U.S.  systems  more  adaptive  to  operational 
variations  and  anomalies,  and  therefore  may  be  a  key  to  resiliency. 

The  DSB  study  [6]  also  states  “two  promising  space  system  application  areas  for 
autonomy  are  the  increased  use  of  autonomy  to  enable  an  independent  acting  system 
and  automation  as  an  augmentation  of  human  operation.  In  such  cases,  autonomy’s 
fundamental  benefits  are  to  increase  a  system’s  operational  capability  and  provide 
cost  savings  via  increased  human  labor  efficiencies,  reducing  staffing  requirements  and 
increasing  mission  assurance.”  The  DSB  study  also  highlights  the  need  to  develop 
automated  planning  to  facilitate  the  decomposition  of  high  level  objectives  into  a  series 
of  actions  to  achieve  them  [6] . 

Accurate  and  timely  space  situational  awareness  (SSA)  is  critical  to  autonomous 
satellite  resiliency.  Specifically,  the  need  for  accurate  tracking  and  characterization  of 
orbiting  objects  is  necessary  to  prevent  unintended  consequences,  such  as  collisions,  which 
could  result  from  maneuvering.  The  NSSS  highlights  the  importance  of  SSA  to  ensure 
safe  space  operations  [2].  SSA  is  particularly  relevant  to  autonomous  maneuver  generation 
While  the  DoD  and  other  organizations  track  over  20, 000  objects,  the  are  still  “hundreds 
of  thousands  of  additional  objects  that  are  too  small  to  track”  [2].  As  a  result,  SSA  is  a  top 
priority  for  the  DoD  space  enterprise.  Specifically,  the  NSSS  highlights  the  need  for  SSA 
to  be  obtained  in  higher  quantities  and  with  better  quality  [2]. 

1.2  Background 

The  field  of  spacecraft  trajectory  optimization  has  been  extensively  researched.  The 
development  of  modern  tools  such  as  evolutionary  algorithms  (EAs)  and  metaheuristics 
have  made  a  significant  impact  on  the  field.  The  impact  results  from  the  fact  that  EAs 


3 


and  metaheuristics  do  not  require  initial  guesses,  something  on  which  more  traditional 
methods  are  dependent.  Additionally,  EAs  are  more  likely  to  find  a  global  minimum  than 
more  traditional  methods.  The  use  of  EAs  and  metaheuristics  in  spacecraft  trajectory 
optimization  has  seen  a  dramatic  increase  due  to  these  benefits.  The  limitations  of  EAs, 
namely  that  problems  must  be  parameterized  into  a  relatively  small  set  of  variables,  can  be 
overcome  by  employing  more  traditional  optimization  techniques  to  refine  results  generated 
by  EAs.  In  fact,  the  current  state-of-the-art  in  trajectory  optimization  is  to  utilize  an 
EA  or  metaheuristic  independently  or  as  a  method  to  generate  initial  guesses  for  a  direct 
transcription  method  [7]. 

Several  researchers  have  employed  these  techniques  to  investigate  interplanetary 
missions  [8-25]  or  asteroid  rendezvous  and  interception  [26-31].  There  is  significantly  less 
research  in  optimal  trajectory  design  to  achieve  mission-focused  ground  effects.  Existing 
research  in  this  field  has  focused  on  orbit  design  for  optimal  coverage  [32,  33]  or  low-thrust 
maneuvering  to  improve  responsive  coverage  of  designated  ground  sites  [34,  35]. 

Currently,  there  is  no  trajectory  optimization  research  focused  on  spacecraft  resiliency. 
The  purpose  of  this  dissertation  is  to  develop  resiliency  maneuvers  and  the  tools  which  will 
enable  their  autonomous  generation.  This  research  utilizes  modem  optimization  methods 
to  demonstrate  their  utility  in  solving  several  spacecraft  trajectory  optimization  problems, 
such  as  impulsive  and  continuous  low-thrust  resiliency  maneuvers  as  well  as  hybrid  optimal 
control  (HOC)  problems. 

1.3  Research  Objectives 

The  primary  objective  of  this  dissertation  is  to  develop  spacecraft  resiliency  maneuvers 
and  the  tools  which  enable  their  autonomous  optimization.  This  objective  is  accomplished 
in  three  phases,  which  are  covered  in  Chapters  3,  4,  and  5.  The  first  phase  consists  of 
the  design  and  optimization  of  impulsive  resiliency  maneuvers.  This  phase  is  the  jumping 
off  point  for  this  dissertation  because  impulsive  maneuvers  can  be  defined  by  a  relatively 
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small  set  of  parameters,  which  allows  for  a  performance  evaluation  of  various  optimization 
algorithms.  The  second  phase  of  this  research  extends  resiliency  to  continuous-thrust 
maneuvers,  which  require  the  definition  of  a  large  control  history.  The  final  phase  of  this 
research  investigates  maneuvers  designed  to  increase  SSA.  The  optimization  of  these  SSA 
maneuvers  are  formulated  as  hybrid  optimal  control  problems,  which  consist  of  a  mixture 
of  categorical  and  continuous  variables.  The  results  from  all  three  phases  demonstrate  the 
potential  for  the  autonomous  optimization  of  spacecraft  resiliency  maneuvers  in  support  of 
human  operations. 

1.4  Document  Preview 

This  dissertation  follows  the  scholarly  article  format,  in  which  the  research  contri¬ 
butions  in  Chapters  3,  4,  and  5  are  presented  as  they  appeared/were  submitted  to  various 
journals.  The  document  is  structured  according  to  the  following  outline. 

Chapter  2  provides  background  on  the  coordinate  frames  and  governing  equations 
of  motion  employed  in  this  dissertation.  Additionally,  it  presents  a  literature  review 
detailing  current  and  past  research  relevant  to  autonomous  trajectory  optimization.  The 
literature  review  is  divided  into  three  sections.  The  first  provides  information  on  enabling 
techniques  in  orbital  mechanics  which  are  foundational  to  the  methods  described  in  this 
dissertation.  The  second  section  details  optimization  techniques  and  the  final  section 
provides  a  description  of  relevant  research  in  spacecraft  trajectory  optimization. 

Chapter  3  develops  an  impulsive  maneuvering  strategy  to  enable  satellite  resiliency 
and  evaluates  several  EAs  in  the  optimization  of  these  types  of  maneuvers.  Example  results 
are  presented  for  single,  double,  and  triple  pass  scenarios  over  a  specified  geographic  region 
on  the  surface  of  the  Earth.  This  work  was  accepted  for  published  by  the  American  Institute 
of  Aeronautics  and  Astronautics  (AIAA)  Journal  of  Spacecraft  and  Rockets  in  July  2014. 

Chapter  4  presents  a  continuous,  low-thrust  implementation  of  the  maneuvers  defined 
in  Chapter  3.  Eeasible  solutions  to  the  low-thrust  problems  presented  are  generated  using 
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particle  swarm  optimization  (PSO)  algorithms,  which  are  used  to  seed  a  direct  optimization 
method  to  determine  the  true  optimal  trajectory  and  control  history.  Example  results  are 
presented  for  single,  double,  and  triple  pass  scenarios.  This  work  is  under  peer  review  for 
publication  in  the  AIAA  Journal  of  Spacecraft  and  Rockets. 

Chapter  5  introduces  an  impulsive  maneuvering  strategy  to  deliver  a  spacecraft  to  its 
final  mission  orbit  while  providing  an  en-route  inspection  of  an  uncharacterized  orbiting 
target  in  cooperation  with  a  ground-based  sensor.  The  performance  of  four  different  HOC 
algorithms  are  investigated  in  the  optimization  of  a  simple  three  target  problem.  The  best 
performing  algorithm  is  then  utilized  to  optimize  a  fifteen  target  problem.  This  work  is 
under  peer  review  for  publication  in  Acta  Astronautica. 

Chapter  6  summarizes  the  major  contributions  of  this  research  and  highlights  potential 
areas  for  future  work. 
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II.  Background 


As  stated  in  Chapter  1,  the  goal  of  this  research  is  to  develop,  optimize,  and 
enable  the  autonomous  generation  of  maneuvers  that  enhance  spacecraft  resiliency.  The 
field  of  spacecraft  trajectory  optimization  requires  a  fundamental  understanding  of  both 
astrodynamics  and  optimization.  The  purpose  of  this  section  is  to  provide  the  necessary 
background  in  these  areas  to  lay  the  foundation  for  the  methods  developed  in  Chapters 
3,  4,  and  5.  This  background  is  divided  into  four  sections:  coordinate  frames,  system 
dynamics,  enabling  techniques,  and  optimization  techniques. 

2.1  Coordinate  Frames 

The  methods  developed  in  subsequent  chapters  utilize  a  variety  of  coordinate  frames, 
each  of  which  is  more  convenient  than  others  for  various  applications.  This  dissertation 
employs  five  different  coordinate  frames:  the  geocentric  equatorial  coordinate  frame  (UK), 
the  perifocal  coordinate  frame  (PQW),  the  topocentric  horizon  coordinate  frame  (SEZ), 
the  local  vertical,  local  horizontal  coordinate  frame  (RSW),  and  the  cylinder  coordinate 
frame  (CYL).  Definitions  of  the  UK,  PQW,  SEZ,  and  RSW  frames  are  provided  in  [36,  pp. 
153-166]  and  presented  here  for  completeness.  The  CYE  frame  was  developed  as  part  of 
this  research  and  is  defined  completely  in  Chapter  5. 

2.1.1  Geocentric  Equatorial  Coordinate  Frame 

The  most  common  coordinate  frame  used  throughout  this  dissertation  is  the  UK  frame. 
Its  origin  is  the  center  of  the  earth  and  the  earth’s  equatorial  plane  is  the  fundamental  plane 
of  the  frame.  The  principle  axis  7  points  toward  the  vernal  equinox  and  is  coincident  with 
the  intersection  of  the  equatorial  and  ecliptic  planes.  The  K-axis  is  perpendicular  to  the 
equatorial  plane  and  points  towards  the  Earth’s  north  pole.  The  /-axis  completes  the  right- 
handed  coordinate  system.  Eigure  2. 1  depicts  the  UK  frame. 
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Figure  2.1:  Geocentric  equatorial  coordinate  frame 

For  the  duration  of  this  dissertation,  the  states  of  all  spacecraft  are  defined  in  Cartesian 
coordinates  whenever  the  UK  frame  is  used.  As  a  result,  the  state  of  a  spacecraft  in  the  UK 
frame  is  given  by  the  position  r  and  velocity  v  vectors  shown  in  Equation  2. 1 . 

r  =  xl  +  yJ  +  zK 

(2.1) 

V  =  vj  +  VyJ  +  V^k 

2.1.2  Perifocal  Coordinate  Frame 

The  PQW  frame  is  convenient  for  describing  the  motion  of  a  spacecraft  in  the  orbital 
plane.  The  origin  of  the  PQW  frame  is  the  center  of  the  earth  and  its  fundamental  plane 
is  coplanar  with  the  satellite’s  orbital  plane.  The  principal  axis  P  is  aligned  with  perigee 
of  the  satellite’s  orbit.  The  Q-axis  is  in  the  fundamental  plane  and  90°  from  the  P-axis 
in  the  direction  of  motion.  The  W-axis  is  normal  to  the  orbital  plane  and  completes  the 
right-handed  system.  Figure  2.2  depicts  the  PQW  frame. 
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Figure  2.2:  Perifocal  coordinate  frame 

The  rotation  of  a  position  vector  in  the  UK  frame  to  a  corresponding  vector  rpgw 
in  the  PQW  frame  is  defined  by  Equation  2.2.  The  variables  co,  inc,  and  are  the  orbit’s 
argument  of  perigee,  inclination,  and  right  ascension  of  the  ascending  node,  respectively. 
Rl  and  R3  are  rotation  matrices  about  the  first  and  third  axes,  respectively. 

rpQw  =  R3  (co)Rl  (inc)  R3  (Q.)  ruK  (2.2) 

It  is  important  to  note  that  the  PQW  frame  is  undefined  for  equatorial  or  circular  orbits. 
For  circular  orbits,  it  is  common  to  use  the  nodal  coordinate  frame  in  place  of  the  PQW 
frame.  In  such  cases,  the  P-axis  is  defined  to  be  coincident  with  the  ascending  node  of  the 
satellite’s  orbit.  A  vector  in  the  nodal  frame  can  be  found  according  to  Equation  2.2  where 
oj  is  replaced  with  zero. 
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Some  of  the  techniques  used  throughout  this  dissertation  define  the  states  of  spacecraft 
in  the  PQW  and  nodal  frames  using  spherical  coordinates.  Figure  2.3  depicts  the  definitions 
of  these  spherical  coordinates  in  the  PQW  frame.  In  such  cases,  r  represents  the  magnitude 
of  the  position  vector,  if/  is  the  angle  measured  from  the  P-axis  to  the  spacecraft  in  the 
orbital  plane,  and  (f)  (not-depicted)  is  the  out-of-plane  angle. 
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Figure  2.3:  Spherical  coordinate  definitions  in  perifocal  coordinate  frame 

2.1.3  Topocentric  Horizon  Coordinate  Frame 

The  SEZ  coordinate  frame  is  an  Earth-based  reference  system,  the  origin  of  which  is 
located  at  a  point  on  the  earth’s  surface  defined  by  its  geocentric  latitude  O  and  longitude 
A.  The  SEZ  frame  rotates  with  the  earth  and  is  oriented  such  that  the  S  axis  points  south 
from  the  origin  and  the  E  axis  points  east.  The  Z  axis  is  normal  to  the  earth’s  surface. 
The  rotation  from  the  UK  frame  into  the  SEZ  frame  is  shown  in  Equation  2.3  where 
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is  the  rotation  rate  of  the  Earth  and  tf  is  the  current  local  sidereal  time  at  the  origin  of  the 
SEZ  frame.  R2  and  R3  are  rotation  matrices  about  the  second  and  third  axes,  respectively. 
Eigure  2.4  depicts  the  SEZ  coordinate  frame. 


f  SEZ  -  R2  (n /2  -  ^)  R3  {A  +  co^tj)  r uk  (2.3) 


z 
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Eigure  2.4:  Topocentric  horizon  coordinate  frame 


The  SEZ  frame  is  employed  in  this  dissertation  to  determine  a  satellite’s  line-of-sight 
contact  with  a  ground  site,  which  occurs  when  the  Z  component  of  a  satellite’s  position 
vector  in  the  SEZ  frame  is  positive. 
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2.1.4  Local  Vertical,  Local  Horizontal  Coordinate  Frame 

The  RSW  frame  is  a  satellite-based  coordinate  frame,  the  origin  of  which  is  the 
orbiting  satellite.  The  principle  R-axis  is  aligned  with  the  vector  connecting  the  origin 
of  the  earth  to  the  satellite.  The  S  -axis  is  perpendicular  to  R  and  points  in  the  direction  of 
the  satellite’s  velocity  vector  while  the  IT-axis  is  perpendicular  to  the  orbit  plane.  Equation 
2.4  provides  the  transformation  for  a  vector  rpgvr  in  the  PQW  frame  into  a  vector  rRsw  in 
the  RSW  frame,  where  v  is  the  true  anomaly.  Figure  2.5  shows  the  RSW  frame. 

fRsw  =  R3(v)  r PQW  (2.4) 


Figure  2.5:  Focal  vertical,  local  horizontal  coordinate  frame 
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2.2  Orbital  Mechanics 


The  entirety  of  this  research  focuses  on  Earth-orbiting  satellites.  Consequently,  this 
section  will  focus  on  the  dynamics  of  a  satellite  as  it  orbits  the  earth.  For  the  purposes  of 
this  research,  two  sets  of  dynamical  equations  are  presented  here.  The  first  set  of  equations 
are  employed  for  satellite  motion  in  the  UK  frame  while  the  second  set  are  utilized  in  the 
PQW  or  nodal  frames. 

The  underlying  principles  for  the  motion  of  the  spacecraft  about  the  earth  result  from 
Newton’s  second  law  and  universal  law  of  gravitation.  Several  resources  [36,  pp.  20- 
31],  [37,  pp.  1-40],  and  [38,  pp.  130-138]  present  derivations  of  the  equations  of  motion 
beginning  with  these  underlying  principles  and  several  simplifying  assumptions.  These 
assumptions,  known  as  the  two-body  assumptions,  include: 

1.  The  coordinate  frame  is  inertial,  meaning  that  it  does  not  rotate  or  accelerate. 

2.  The  earth  and  spacecraft  are  modeled  by  spheres  of  uniform  density,  allowing  them 
to  be  treated  as  point  masses. 

3.  The  mass  of  the  spacecraft  is  much  less  than  that  of  the  earth. 

4.  The  only  forces  acting  on  the  earth  and  spacecraft  are  the  gravitational  forces  between 
them. 

2.2.1  Equations  of  Motion  in  Geocentric  Equatorial  Frame 

The  two-body  assumptions  lead  to  the  equations  of  motion  governing  spacecraft 
motion  about  the  earth.  The  state  of  the  spacecraft  in  Cartesian  coordinates  is  defined 
by  position  and  velocity  vectors,  r  and  v,  respectively.  In  the  UK  frame,  r  and  v  take  the 
form  shown  in  Equation  2.5. 

r  =  xl  +  yJ  +  zK 

(2.5) 

V  =  Vj  -I-  VyJ  +  v^K 
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The  Cartesian  form  of  the  equations  of  motion  are  presented  in  Equation  2.6  where  /i 
is  the  Earth’s  gravitational  eonstant. 

(2.6) 

All  maneuvers  in  this  dissertation  defined  in  the  UK  frame  are  impulsive.  That  is,  they 
oeeur  instantaneously.  A  maneuver  is  defined  by  a  veetor  AF  with  eomponents  in  eaeh 
axis  of  the  UK  frame  as  shown  in  Equation  2.7.  The  eost  of  eaeh  maneuver  is  AF,  the 
magnitude  of  AF,  whieh  is  equal  to  the  differenee  between  the  veloeity  veetor  at  the  instant 
after  the  maneuver,  v"^,  and  the  veloeity  veetor  at  the  instant  prior  to  the  maneuver,  v~. 

AF  =  V+-V-  (2.7) 

2.2.2  Equations  of  Motion  in  Perifocal  and  Nodal  Frames 

The  two-body  assumptions  also  make  it  possible  to  derive  two  eonstants  of  orbital 
motion,  speeifie  angular  momentum  (SAM)  and  speeifie  meehanieal  energy  (SME). 
Original  derivations  for  SAM  and  SME  are  presented  in  [36,  pp.  23-27]  and  [37,  pp. 
14-18].  The  SAM  of  an  orbit,  h,  can  be  found  aeeording  to  Equation  2.8. 

h  =  rxv  (2.8) 

The  eonservation  of  SAM  implies  that  the  motion  of  a  non-maneuvering  spaeeeraft  is 
eonfined  to  its  orbital  plane.  As  a  result,  eonsider  the  motion  of  a  spaeeeraft  in  the  PQW 
or  nodal  frames.  The  eonservation  of  SAM  dietates  that  the  motion  of  a  non-maneuvering 
spaeeeraft  is  restrieted  to  the  PQ  plane.  Consequently,  only  four  states  are  neeessary  to 
eompletely  deseribe  the  motion  of  a  spaeeeraft  in  the  PQW  or  nodal  frames  if  motion  is 
restrieted  to  the  orbital  plane.  Throughout  this  dissertation,  spherieal  eoordinates  are  used 
to  represent  the  state  of  a  spaeeeraft  in  the  PQW  or  nodal  frames.  Eurther,  all  maneuvers  in 
the  PQW  frame  are  eoplanar  and  modeled  as  eontinuous  using  a  thrust  aeeeleration  veetor. 
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Aj.  The  thrust  acceleration  vector  is  defined  by  its  magnitude,  Aj  and  the  angle  77  measured 
from  local  horizontal  to  Aj,  as  shown  in  Figure  2.6.  The  local  horizontal  is  defined  as  a 
line  perpendicular  to  the  position  vector  in  the  orbital  plane.  . 


Figure  2.6:  Thrust  acceleration  vector 


The  resulting  equations  of  motion  in  the  PQW  and  nodal  frames  are  defined  in 
Equation  2.9. 

r  =  Vr 


K 


Yi 

r 

^  ^  +  At-  sin  ?7 

+  At-  cos  rj 


(2.9) 
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The  Ay  corresponding  to  continuous-thrust  maneuvers  is  found  according  to  Equation 
2.10,  where  tstart  is  the  maneuver  start  time  and  tend  is  the  maneuver  end  time. 

J'^^end 

Ardt  (2.10) 

^start 

2.3  Literature  Review 

The  field  of  spacecraft  trajectory  optimization  has  been  studied  extensively  since 
the  1960s  when  Lawden  [39]  applied  the  calculus  of  variations  (COV)  to  determine  the 
necessary  conditions  for  optimal  impulsive  transfers  between  circular  orbits.  None  of 
the  previous  research,  however,  has  developed  maneuvers  designed  to  enhance  spacecraft 
resiliency.  This  literature  review  provides  a  comprehensive  overview  of  current  and  past 
research  techniques  that  enable  the  optimization  of  resiliency  maneuvers  with  varying 
levels  of  autonomy.  The  areas  which  provide  the  foundation  of  this  research  are  divided  into 
three  categories:  enabling  techniques,  numerical  optimization  techniques,  and  spacecraft 
trajectory  optimization  research. 

2.3.1  Enabling  Techniques 

The  methods  developed  to  design  and  optimize  resiliency  maneuvers  described  in 
Chapters  3,  4,  and  5  of  this  dissertation  employ  several  techniques  developed  by  other 
researchers.  This  section  of  the  literature  review  is  meant  to  provide  brief  descriptions  of 
these  enabling  methods  and  references  of  their  use  in  other  research.  The  techniques  are 
analogous  to  one  another  because  all  are  used  to  determine  the  trajectory  that  will  deliver 
a  spacecraft  from  one  position  to  another  in  a  specified  time.  They  are  distinct,  however, 
due  to  the  coordinate  frames  they  utilize  or  the  types  of  trajectories  they  generate:  either 
impulsive  or  continuous  thrust. 

2.3.1. 1  Gauss’ Problem 

The  first  enabling  method  used  is  a  solution  to  the  classic  Lambert’s  problem 
(originally  proposed  by  Gauss),  which  is  to  determine  the  initial  and  final  velocity  vectors 
of  an  orbit  segment  which  connects  two  position  vectors  in  a  specified  time-of-fiight.  These 
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velocity  vectors  can  be  used  to  determine  the  impulsive  AV  required  to  transfer  a  satellite 
from  its  current  orbit  to  a  specified  position  in  a  fixed  amount  of  time.  A  Lambert’s  problem 
solver  is  particularly  useful  because  it  allows  a  trajectory  to  be  defined  by  a  small  number 
of  parameters. 

Many  techniques  have  been  developed  in  the  solution  of  Lambert’s  problem,  most 
famously  Gauss’  solution,  derivations  of  which  are  presented  in  [37,  pp.  258-264],  [36,  pp. 
472-475]  and  [40,  pp.  325-342].  [41]  provides  a  software  algorithm  to  solve  Lambert’s 
problem  which  is  used  throughout  this  dissertation. 

2.3. 1.2  Shape-Based  Low-Thrust  Trajectory  Approximation 
Shape-based  low-thrust  trajectory  approximation  is  employed  to  determine  discrete 
approximations  to  low  thrust-trajectories  connecting  two  known  positions  in  a  specified 
time.  The  approximation  was  originally  developed  and  presented  in  [42,  43].  The 
highlights  are  presented  here  for  clarity.  [42]  developed  a  two-dimensional  approximation 
which  is  appropriate  for  interception  trajectories  restricted  to  motion  occurring  in  a  fixed- 
plane.  The  approximation  utilizes  a  spherical  coordinate  system  and  provides  a  sixth- 
degree  inverse  polynomial  approximation  of  r  as  a  function  of  if/,  shown  in  Equation  2. 1 1. 


r(i/r)  = 


1 


(2.11) 


a  +  bif/  +  +  dij/^  -I-  eij/^  +  -l- 

The  values  for  a,  b,  and  c  are  dependent  on  the  initial  boundary  conditions:  position 
magnitude  r„  velocity  magnitude  v„  and  flight  path  angle  y,.  Let  the  initial  angle  if/i 
equal  zero  and  the  final  angle  ij/f  equal  the  total  angle  to  be  traveled  by  the  maneuvering 
spacecraft.  Then  a,  b,  and  c  take  on  the  values  shown  in  Equation  2.12,  where  p.  is  the 
gravitational  parameter  of  the  body  about  which  the  spacecraft  is  orbiting. 


where 


.  Vi  cos  Ji 
lAi  = - 


(2.12) 


(2.13) 
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The  value  for  d  is  chosen  to  specify  the  transfer  time  and  must  be  solved  with  a 
root  finding  function.  The  values  for  e,  f,  g  are  dependent  on  d  and  the  final  boundary 
conditions:  transfer  time  tf,  position  magnitude  r/,  velocity  magnitude  v/,  and  flight  path 
angle  y/. 


e 

1 

“2^J 

^  -  (a  +  bij/f  +  cil/j  +  dilffj 

f 

(N 

00 

00 

1 

{b  +  2cil/f  +  3dif/j^ 

g 

20  -Sifff 

The  shape  based  approximation  is  complete  when  a  value  of  d  satisfies  the  relationship 
in  Equation  2.15. 


[l/r(^)  +  2c  +  +  20fil/^  +  30giff^]  di^ 


(2.15) 


[42]  notes  that  supplying  an  initial  guess  of  J  =  0  into  the  MATLAB  root  finding 
function  provides  sufficient  robustness  to  satisfy  the  relationship  defined  in  Equation 
2.15.  The  approximation  for  the  thrust  acceleration  is  found  according  to  Equation  2.16. 


At  — 


6d  +  24-eif/  +  60fif/^  +  120g^^  -  (tany)  /r 


2r^  cos  y  (1/r  +  2c  +  6Ji/^  +  I2eif/^  +  20fif/^  +  30gi]/^)^ 


where 


tany  =  —r  =  -r{b  +  2cif/  +  ^dif/  +  Aeij?  +  5/i/^"^  + 


(2.16) 


(2.17) 


The  approximation  is  assumed  to  be  a  prograde  trajectory,  implying  that  the  flight  path 
angle,  y,  must  be  between  -nl2  and  ;r/2  The  corresponding  AT  can  be  found  by  integrating 
Equation  2.18  using  quadrature  and  the  trapezoidal  rule. 


AT  =  I  ^  diA 


r*lp 

Jo 


(2.18) 


where 

;  ^  d _ 1 _ 

r^(l/r  +  2c  +  6d4i  +  12eil/^  +  20f\f/^  +  30g\f/^) 


(2.19) 
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2.3. 1.3  Time-Fixed  Maneuvers  in  Relative  Orbits 


The  final  enabling  technique  employed  in  this  research  is  similar  to  a  Lambert  solver  in 
that  it  is  used  to  generate  the  initial  and  final  velocities  which  connect  two  position  vectors 
in  a  specified  time.  This  method,  however,  is  applied  to  a  chaser  satellite  in  a  relative  orbit 
with  a  target  satellite.  The  motion  of  the  chaser  is  described  in  the  RSW  frame  using  the 
linearized  equations  of  motion  originally  proposed  by  Hill  [44]  and  Clohessy  and  Wiltshire 
[45],  shown  in  Appendix  B. 

The  initial  and  final  relative  positions  of  the  target  in  the  RSW  frame,  r,  and  r/, 
respectively,  are  defined  in  Equations  2.20  and  2.21.  The  time-of-flight  is  t,/  seconds. 


=  Xik  +  yS  +  ZiW 

(2.20) 

=  Xfk  +  yfS  +  ZfW 

(2.21) 

Irvin  et  al.  [46]  described  a  technique  to  determine  the  scaled  initial  and  final  velocities 
of  the  chaser,  v,  and  V/,  respectively,  given  r,,  r/,  and  Uf.  The  scaling  is  such  that  the  time 
is  scaled  by  the  orbital  period  of  the  target  satellite.  That  is,  the  scaled  time  f  =  {njln)  tif, 
where  n  is  the  mean  motion  of  the  target  satellite.  The  position  vectors  are  unaffected  by 
this  scaling.  That  is,  fi  =  r,  and  ff  =  rf. 

Equations  2.22  and  2.23  show  v,-  and  Vf,  respectively,  as  functions  of  fi,  ff,  and  f. 
Other  values  in  the  equations  are  functions  of  known  quantities:  S  =  sin  Inf,  C  =  cos  2nf, 


and  Ay  =  y/  -  y,-. 


A, 

-4S+6fffC 
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(2.23) 


Thus,  it  is  possible  to  determine  the  velocities  needed  to  connect  two  position  vectors 
in  the  RSW  frame  given  the  time  of  flight  between  them. 

2.3.2  Optimization  Techniques 

The  purpose  of  this  section  is  provide  relevant  background  information  on  optimiza¬ 
tion  techniques  utilized  to  generate  optimal  trajectories.  Betts  [47]  and  more  recently, 
Conway  [7]  authored  surveys  on  state-of-the  art  numerical  optimization  techniques.  Both 
provide  detailed  descriptions  of  several  methods  employed  in  the  solution  of  optimal  con¬ 
trol  problems,  which  are  generally  classified  into  three  categories:  direct  methods,  indirect 
methods,  and  evolutionary  algorithms  (EAs)  or  metaheuristics. 

This  section  is  divided  into  two  parts.  The  first  details  more  traditional  numerical 
optimization  techniques,  namely  direct  and  indirect  methods.  The  second  section  describes 
a  separate  class  of  numerical  optimization  techniques  known  as  EAs  and  metaheuristics. 

2.3.2. 1  Direct  and  Indirect  Techniques 

Indirect  methods  utilize  the  analytical  necessary  conditions  derived  from  the  COV, 
employed  as  both  constraints  and  states.  Specifically,  additional  states  representing  the 
costates,  also  known  as  Eagrange  multipliers,  of  each  state  must  be  added,  automatically 
doubling  the  size  of  the  problem.  Additional  constraints  resulting  from  the  analytical 
necessary  conditions  must  also  be  added  to  the  problem  constraints. 

Betts  [47]  highlighted  three  primary  drawbacks  to  applying  indirect  methods  to 
solve  trajectory  optimization  problems.  These  include  the  requirement  to  derive  analytic 
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necessary  conditions  for  complicated  dynamical  systems,  potentially  small  convergence 
regions,  and  the  requirement  to  guess  sub-arcs  for  problems  requiring  discrete  variables 
(such  as  a  series  of  thrust-coast  sequences).  Conway  [7]  notes  an  additional  drawback, 
which  is  that  the  costates  have  no  physical  significance.  This  makes  it  very  challenging  to 
determine  the  magnitude  or  even  the  sign  of  the  initial  costate  values  required  for  the  initial 
guess. 

These  challenges  have  resulted  in  the  use  of  direct  methods  to  optimize  the  majority 
of  spacecraft  trajectory  optimization  problems  [7].  One  such  method  is  direct  transcription. 
The  direct  transcription  method  converts  a  continuous  optimal  control  problem  into  a  large 
parameter  optimization  problem  by  discretizing  the  states  and  controls.  The  states  and 
controls  are  defined  at  nodes  and  the  system  dynamics  are  satisfied  using  explicit  or  implicit 
integration  [7]  at  each  node.  The  states  and  controls  are  approximated  linearly  in  between 
each  node.  This  discretization  can  then  be  solved  with  a  nonlinear  programming  (NLP) 
problem  solver.  A  similar  method  called  direct  collocation  discretizes  the  states  and 
controls  in  the  same  fashion,  however,  they  are  approximated  by  higher-order  polynomials 
rather  than  linearly. 

There  are  several  common  collocation  methods  in  which  the  primary  differences  are 
seen  in  the  implicit  integration  rules.  Of  these  methods,  those  employing  Gauss-Lobatto 
or  pseudospectral  methods,  also  known  as  direct  orthogonal  collocation,  [48,  49,  49,  50] 
provide  significant  benefit  with  respect  to  accuracy  [51]. 

[7]  states  that  direct  transcription/collocation  methods  provide  distinct  advantages 
over  indirect  methods.  The  first  benefit  is  that  there  is  no  need  to  derive  the  analytical 
necessary  conditions,  which  can  be  problematic  for  realistic  problems  [51].  They  are  also 
robust  to  poor  initial  guesses. 

Despite  these  benefits,  direct  transcription/collocation  methods  have  two  significant 
limitations.  The  first  is  that  they  require  an  initial  guess,  which  can  be  difficult  to  generate 
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[51].  Additionally,  these  methods  are  likely  to  converge  in  the  neighborhood  of  the  initial 
guess,  which  implies  they  are  likely  to  generate  locally  optimal  solutions. 

2.3.2. 2  Evolutionary  Algorithms  and  Metaheuristics 

Metaheuristics  and  EAs  are  numerical  optimization  methods  that  define  an  optimiza¬ 
tion  problem  in  a  finite  number  of  parameters.  These  methods  are  similar  to  one  another  be¬ 
cause  they  do  not  require  initial  guesses,  but  rather  randomly  initialize  populations  through¬ 
out  the  solution  space.  EAs  employ  methods  to  preserve  the  fittest  (most  optimal)  member 
of  a  population  to  serve  as  parents  for  subsequent  generations.  Metaheuristics  use  stochas¬ 
tic  methods  over  several  iterations  to  generate  optimal  solutions  [7]. 

Metaheuristics  and  EAs  have  two  distinct  advantages  over  direct  transcription/collo¬ 
cation  methods.  The  first  of  these  is  that  they  do  not  require  an  initial  guess.  The  second 
is  that  they  are  more  likely,  although  not  guaranteed,  to  converge  to  a  globally  optimal 
solution  [7,  51]. 

In  fact,  Conway  [7]  specifically  states  that  the  best  solution  method  “in  almost  all 
cases  is  that  the  best  approach  is  an  evolutionary  algorithm  or  metaheuristic  alone  or  in 
combination  with  a  direct  transcription  method.” 

There  are  several  different  EAs  and  metaheuristics,  and  each  uses  different  principles 
to  generate  optimal  solutions.  Two  popular  variants  of  metaheuristic  and  EA  are  particle 
swarm  optimization  (PSO)  and  genetic  algorithm  (GA),  respectively.  Both  algorithms  are 
utilized  throughout  this  dissertation. 

2. 3. 2.2.1  Particle  Swarm  Optimization  The  PSO  algorithm  is  a  specific 
type  of  metaheuristic  utilized  in  this  dissertation.  PSO  was  initially  developed  by  Eberhart 
and  Kennedy  [52,  53].  The  algorithm  and  relevant  research  related  to  its  performance  is 
presented  here. 

Consider  an  unconstrained,  n-dimensional  optimization  problem.  The  search  space 
S  of  the  problem  is  defined  by  the  bounds  on  each  variable.  Eor  example,  the  design 
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variable  has  lower  and  upper  limits  and  respectively.  The  PSO  is  initialized  by 
assigning  each  particle  a  position  and  velocity  vector  in  5  according  to  a  uniform  random 
distribution.  The  particle’s  position  Xp  and  velocity  Vp  vectors  in  5  take  the  forms 
shown  in  Equation  2.24. 

Xp  =  ^x]„  xl,...,  .r"] 


Vp  =  [^Vp,  Vp, . . . ,  v"j 


(2.24) 


The  bounds  on  each  component  in  Xp  match  the  bounds  in  5  corresponding  to  that 
component.  That  is,  the  dimension  of  each  particle’s  position  vector  is  bounded  by  xV^ 
and  Similarly,  the  dimension  of  each  particle’s  velocity  vector,  v^,  is  subject  to  an 
upper  bound  =  x^^^  -  x‘^.^  and  a  lower  bound  v‘^.^  = 


r'  < 

'^min  —  —  -^max 


mm  —  ^  p  —  '^max 


(2.25) 


The  cost  associated  with  each  particle’s  position  Jp  is  calculated  at  each  iteration.  The 
velocity  of  each  particle  is  updated  based  on  the  particle’s  relative  position  in  S  to  the  best 
position  visited  by  swarm  {gbest)  and  the  best  position  ever  visited  by  that  specific  particle 
ipbest)-  Each  particle’s  position  in  S  is  then  updated  by  adding  its  new  velocity  to  its  current 
position. 

The  original  implementation  of  PSO  [52,  53]  used  the  velocity  update  shown  in 
Equation  2.26,  where  s  is  iteration  number.  The  parameters  ci  and  C2  are  the  cognitive 
and  social  parameters,  respectively.  The  cognitive  parameter  influences  the  velocity  of 
each  particle  towards  (pbest)  while  the  social  parameter  influences  particle  velocity  towards 
(gbest)-  The  variables  z\  and  zi  are  stochastic  parameters  uniformly  distributed  between 
zero  and  one. 


Vp  (s)  =  Fp  (5  -  1)  +  CiZi  (^Pbest  -Xp(s-  1))  +  C2Z2  (gbest  -  Xp(s  -  1))  (2.26) 

If  the  component  of  the  velocity  is  outside  the  bounds  defined  in  Equation  2.25,  it 
is  reset  to  the  closest  boundary.  The  position  of  each  particle  at  the  iteration  is  updated 
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according  to  Equation  2.27,  regardless  of  the  PSO  variant. 


Xp{s)  =  Xp{s-\)  +  Vp{s)  {221) 

Similarly,  if  the  component  of  the  position  is  outside  the  bounds  defined  in  Equation 
2.25,  it  is  reset  to  the  closet  boundary.  This  process  is  repeated  until  a  specified  convergence 
criteria  is  achieved  or  until  a  maximum  number  of  iterations  is  reached. 

Eberhart  and  Kennedy  s’  initial  research  showed  that  the  PSO  algorithm  described 
above  (known  as  the  global  best  particle  swarm  optimization  variant  (GBEST))  had  a 
tendency  to  become  trapped  in  local  extrema.  They  developed  the  local  best  particle  swarm 
optimization  variant  (EBEST)  in  order  to  mitigate  this  problem. 

The  velocity  update  for  EBEST  varies  slightly  from  that  of  GBEST  because  each 
particle  only  shares  information  with  its  q  adjacent  neighbors  on  either  side,  where  2q  is 
the  neighborhood  size.  At  each  iteration,  Jp  (s)  is  compared  to  the  lowest  cost  ever  achieved 
by  any  particle  in  its  neighborhood,  over  the  previous  5  iterations.  If  Jp{s)  < 
then  is  set  equal  to  Jp  (s)  and  the  best  position  ever  visited  by  any  particle  in  the 
neighborhood  Ibest  is  set  equal  to  Xp  (s).  The  velocity  update  for  the  local  PSO  variant  used 
in  this  research  is  shown  in  Equation  2.28. 

Vp  (s)  =  Vp{s-l)  +  CiZl  (pbest  -Xp{s-  1))  +  C2Z2  (he,t  -  Xp{s  -  1))  (2.28) 

Eberhart  and  Shi  demonstrated  success  by  setting  the  number  of  neighbors  to  15% 
of  the  swarm  size  [54].  They  compared  the  performance  of  GBEST  and  EBEST  on 
several  benchmark  functions  and  found  that  EBEST  is  less  susceptible  than  GBEST  to 
local  minima.  This  improved  converge  performance  generally  requires  more  iterations  to 
converge,  and  thus  greater  computational  time. 

Eater  research  on  PSO  focused  on  modifications  to  the  velocity  update  equation.  Shi 
and  Eberhart  [55]  introduced  the  concept  of  an  inertia  weight  w,  which  is  meant  to  balance 
the  global  vs.  local  search  capability  of  the  PSO.  The  inertia  weight  is  a  multiplier  of  each 
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particle’s  current  velocity.  The  resulting  velocity  update  equation  takes  the  form  shown  in 
Equation  2.29 


Vp  (5)  =  wVp  (5  -  1)  +  Cizi  [pbest  -Xp{s-  1))  +  C2Z2  {gbest  -Xp(s-  1))  (2.29) 


[55]  found  that  linearly  decreasing  the  inertia  weight  as  a  function  of  the  iteration 
number  provided  better  performance  than  static  inertia  weights.  This  linear  reduction 
allows  for  exploration  of  5  at  early  iterations  and  exploitation  of  promising  neighborhoods 
in  5  at  later  iterations. 

[56,  57]  introduced  an  additional  parameter,  called  the  constriction  factor,  into  the 
velocity  update  equation.  The  constriction  factor,  is  designed  to  prevent  explosion,  which 
occurs  when  the  particles  in  the  swarm  tend  toward  the  variable  boundaries  in  5.  The 
constriction  factor  is  defined  in  Equation  2.30,  where  (p  =  Ci  +  C2 
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The  corresponding  velocity  update  equation  is  shown  in  Equation  2.31. 


(2.30) 


Vp  (s)  =  X  [Vp  (5  -  1)  +  CiZi  i^Pbest  -  Xp(s-  1))  +  C2Z2  {gbest  -  Xp(s-  1))]  (2.31) 


Eberhart  and  Shi  [58]  compared  the  performance  of  a  PSO  employing  an  inertia 
weight  to  that  of  a  PSO  employing  a  constriction  factor  on  five  benchmark  problems.  They 
discovered  that  the  best  approach  is  to  use  the  constriction  factor  while  defining  a  maximum 
velocity  for  each  variable  equal  its  dynamic  range  in  the  solution  space. 

Trelea  investigated  the  effect  of  swarm  size  on  convergence  success  for  several 
benchmark  functions.  He  found  that  convergence  success  increased  as  the  number  of 
particles  increased,  but  mentions  the  trade  off  between  number  of  particles  and  speed  [59]. 
A  swarm  employing  a  larger  number  of  particles  more  completely  covers  the  solution 
space  and  is  more  likely  to  converge  to  the  globally  optimal  solution.  As  swarm  size 
increases,  the  number  of  cost  functions  evaluations  per  iteration  also  increases,  resulting 


25 


in  slower  computational  performance.  Zhang,  Yu,  and  Hu  investigated  the  effect  of  the 
swarm  parameters  and  determined  (p  should  be  between  4.1  and  4.2  for  high  dimensional 
problems  and  4.05  and  4.3  for  lower  dimensional  problems  [60].  They  do  not  provide, 
however,  a  definition  of  lower  and  higher  dimensional  problems. 

23.2.2.2  Genetic  Algorithms  The  GA  is  an  example  of  an  EA  and  is 
used  in  this  dissertation.  Holland  [61]  originally  developed  the  GA  to  model  natural 
adaptive  processes  and  later  applied  it  to  optimization  problems.  The  GA  begins  with 
an  initial  population  uniform  randomly  distributed  throughout  the  solution  space  5.  The 
population  in  subsequent  generations  results  from  some  combination  of  members  of  the 
previous  generation,  called  parents.  This  is  accomplished  using  two  primary  methods: 
selection  and  reproduction. 

Selection  determines  which  members  of  the  current  population  will  be  chosen  as 
parents  for  the  next  generation.  It  is  a  probabilistic  method  in  which  more  optimal  members 
are  more  likely  to  be  chosen  as  parents.  Talbi  [62]  highlighted  several  methods  of  selection 
such  as  roulette  wheel  selection,  stochastic  universal  sampling,  tournament  selection  and 
rank-based  selection. 

Roulette  wheel,  or  proportionate,  selection  is  the  most  common  selection  method  used 
in  GAs  [62-64].  In  this  method,  each  member  p  of  the  population  is  assigned  a  fitness  value 
based  on  the  objective  function  value  corresponding  to  that  individual.  The  probability  of 
that  individual  being  selected  as  a  parent  for  the  next  generation  is  proportional  to  the 
fitness  value.  That  is,  more  fit  individuals  are  assigned  larger  sections  of  the  roulette  wheel. 

Roulette  wheel  selection  is  performed  by  randomly  selecting  a  position  on  the  roulette 
wheel,  which  corresponds  to  an  individual  in  the  population.  This  process  is  repeated  T 
times  to  choose  T  parents  for  the  next  generation.  This  form  of  selection  makes  it  more 
likely  that  individuals  with  better  fitness  values  will  be  selected  as  parents.  [62]  noted  two 
specific  drawbacks  to  roulette  wheel  selection.  The  first  is  that  it  introduces  bias  towards 
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strong  performing  individuals  early  in  the  algorithm  which  can  cause  convergence  to  local 
optima.  Additionally,  roulette  wheel  selection  does  not  perform  as  well  when  all  members 
of  the  population  have  similar  fitness  values. 

An  alternate  selection  method  called  stochastic  universal  sampling  (SUS)  is  designed 
to  reduce  roulette  wheel  bias.  Each  individual  in  the  population  is  assigned  space  on  a 
roulette  wheel  proportional  to  the  fitness  value.  The  SUS  method,  however,  is  designed 
to  choose  all  E  parents  with  one  spin  of  the  wheel,  so  an  additional  wheel  with  E  equally 
spaced  pointers  is  placed  around  the  the  original  wheel.  When  the  wheel  is  stops,  all  E 
positions  are  chosen  at  once. 

Another  alternative  is  the  tournament  selection  method,  in  which  individuals  are 
randomly  chosen  from  the  population  to  compete  in  a  tournament  against  one  another.  The 
winner  of  the  tournament  is  the  individual  with  the  best  fitness  value.  A  tournament  can 
include  all  members  of  the  population,  but  the  standard  tournament  size  is  two  members 
[62].  This  process  is  repeated  T  times  to  choose  E  parents  for  the  next  generation. 

Reproduction  is  accomplished  via  two  operations  called  mutation  and  crossover.  In 
mutation,  a  small  change  is  made  to  one  of  the  individuals  retained  via  the  selection  process. 
There  are  many  methods  to  accomplish  mutation,  but  Talbi  [62]  lists  three  key  principles 
that  each  method  must  meet.  The  first  is  ergodicity,  which  means  that  the  mutation  must 
provide  the  ability  to  reach  all  solutions  in  the  search  space.  The  second  key  principle  is 
validity,  meaning  the  mutation  must  produce  valid  solutions.  The  final  principle  is  locality, 
which  means  the  mutation  must  produce  a  small  change. 

The  crossover  operation  is  the  second  method  of  reproduction  and  is  meant  to  combine 
pieces  of  one  or  more  parent  solutions  preserved  from  the  selection  phase.  Talbi  [62]  lists 
two  key  factors  that  must  be  considered  when  applying  a  crossover  operator.  The  first  of 
these  is  heritability,  which  means  that  each  new  solution  should  inherit  characteristics  from 
each  parent  solution.  The  second  factor  is  validity. 
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The  set  of  new  solutions  generated  via  the  seleetion,  mutation,  and  erossover 
operations  is  ealled  a  generation.  Seleetion  and  reproduetion  are  performed  on  the  new 
generation  and  the  proeess  is  repeated  until  a  defined  stopping  eriteria  has  been  aehieved. 
Examples  of  stopping  eriteria  inelude  a  limit  on  the  number  of  generations  or  a  limit  on  the 
number  of  eonseeutive  generations  in  whieh  the  lowest  eost  solution  has  not  ehanged. 

2. 3. 2.2. 3  Other  Evolutionary  Algorithms  There  are  several  additional 
EAs  seen  throughout  the  literature.  Priee  and  Storn  developed  differential  evolution  (DE), 
whieh  uses  differenees  between  solution  veetors  of  the  population  to  generate  new  veetors 
to  seareh  the  solution  spaee.  This  strategy  is  similar  to  GA  in  that  it  employs  mutation  and 
erossover,  but  the  erossover  operator  is  based  on  the  distanee  between  randomly  ehosen 
veetors  and  the  parent  veetor.  It  has  demonstrated  a  great  deal  of  sueeess  in  the  solution  of 
eontinuous  optimization  problems  [62] .  Ant  eolony  optimization  was  originally  proposed 
by  Dorigo  [65-68]  to  solve  difheult  eombinatorial  problems.  Multiple  authors  have  noted 
that  ant  eolony  optimization  (AGO)  has  demonstrated  sueeess  in  solving  several  different 
types  of  optimization  problems  sueh  as  eombinatorial,  seheduling,  routing,  and  assignment 
[62,  69]. 

2.3.2.2.4  Constrained  Optimization  with  Evolutionary  Algorithms  The 
methods  deseribed  above  do  not  address  methods  to  handle  problem  eonstraints,  whieh 
ean  be  elassified  into  two  eategories:  equality  and  inequality  eonstraints.  The  purpose  of 
this  seetion  is  to  deseribe  researeh  in  eonstraint  handling  teehniques  relevant  to  EAs  and 
metaheuristies. 

Previous  researeh  indieated  that  EAs  have  difheulty  handling  equality  eonstraints  [70]. 
One  eommon  way  to  address  this  difheulty  is  to  eonvert  equality  eonstraints  into  two 
inequality  eonstraints  by  introdueing  an  aeeeptable  toleranee  [70,  71]. 

Miehalewiez  and  Sehoenauer  provided  a  baekground  on  teehniques  for  handling 
eonstraints  when  using  EAs  [72].  They  divided  eonstraint  handling  teehniques  into  four 
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primary  categories:  methods  based  on  preserving  feasibility  of  solutions,  methods  based  on 
penalty  functions,  methods  which  make  a  clear  distinction  between  feasible  and  infeasible 
solutions,  and  hybrid  methods. 

Penalty  functions  are  the  most  commonly  used  method  to  handle  constraints  in  EAs 
and  metaheuristics  [72]  and  work  by  assigning  an  additional  cost  to  any  particle  that 
violates  the  problem  constraints. 

The  simplest  penalty  function  is  the  death  penalty  method,  which  assigns  an  infinite 
cost  to  any  solution  that  violates  a  constraint.  It  has  been  proven  to  be  effective  for  several 
engineering  problems  [73,  74]. 

Joines  and  Houck  introduced  a  dynamic  penalty  function  in  which  the  penalty 
increases  as  the  iteration  number  increases  [75].  A  shortfall  of  the  dynamic  penalty  method 
is  that  the  algorithm  has  a  tendency  to  become  trapped  in  local  optima  due  to  the  rapid 
growth  of  the  penalty  strength  as  iterations  are  increased  [76]. 

The  adaptive  penalty  function  was  originally  developed  by  Bean  and  Hadj-Alouane 
[77,  78]  and  modifies  the  penalty  function  based  on  how  long  the  best  solution  has  been 
in/out  of  the  feasible  subspace.  The  adaptive  penalty  increases  the  penalty  function  if 
the  fittest/best  member  of  the  population  has  not  been  in  the  feasible  subspace  for  a  finite 
number  of  consecutive  iterations.  It  decreases  the  penalty  function  if  the  fittest/best  member 
of  the  population  has  been  in  the  feasible  subspace  for  a  finite  number  of  consecutive 
iterations. 

Despite  the  extensive  research  in  the  realm  of  constraint  handling,  there  is  no  single 
method  that  is  guaranteed  to  provide  the  best  performance  for  all  problems.  Many 
authors  have  stated  that  penalty  functions  must  be  tuned  to  obtain  the  best  results  for 
each  problem  considered  [72,  79,  80].  Penalty  functions  that  are  too  large  can  cause 
premature  convergence  while  penalties  that  aren’t  large  enough  allow  solutions  that  violate 
constraints. 
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2.3.3  Spacecraft  Trajectory  Optimization  Research 

The  field  of  spacecraft  trajectory  optimization  is  extensive.  The  purpose  of  this  section 
is  to  provide  the  reader  with  a  survey  of  current  research  employing  the  techniques  utilized 
in  this  dissertation.  Specifically,  this  section  is  divided  into  two  pieces.  The  first  provides  a 
survey  of  spacecraft  trajectory  optimization  research  which  utilized  an  EA  or  metaheuristic 
alone  or  in  conjunction  with  a  direct  transcription  methods  employing  an  NLP  problem 
solver.  The  second  provides  background  on  spacecraft  trajectory  optimization  research  in 
hybrid  optimal  control  (HOC)  problem,  which  consist  of  a  combination  of  categorical  and 
continuous  variables. 

2.3.3. 1  Evolutionary  Algorithms  in  Trajectory  Optimization 

The  use  of  metaheuristics  and  EAs  to  solve  spacecraft  trajectory  optimization 
problems  has  increased  dramatically  in  recent  years.  The  vast  majority  of  research  in  the 
field  has  focused  on  finding  optimal  solutions  to  a  variety  of  interplanetary  trajectories  and 
missions  [8-25].  Several  authors  have  also  implemented  heuristics  to  solve  rendezvous 
and  docking  trajectory  problems.  Luo  et  al.  applied  a  hybrid  GA  to  solve  a  minimum- 
impulsive  minimum-time  rendezvous  with  constraints  in  the  RSW  frame  [26].  Stupik  et 
al.  used  a  PSO  to  solve  a  continuous  thrust  minimax  pursuit/evasion  problem  in  the  RSW 
frame  where  a  target  spacecraft  is  trying  to  maximize  the  rendezvous  time  as  a  pursuer 
spacecraft  is  trying  to  minimize  the  rendezvous  time  with  the  target  [27]. 

Additional  researchers  studied  different  types  of  trajectory  optimization  problems 
using  PSO.  These  include  optimal  impulsive  transfers  between  several  different  orbit 
types  [25,  81,  82],  impulsive  and  finite  thrust  rendezvous  trajectories  [83],  Lyapunov 
orbits  around  the  Lagrange  points  in  the  Earth-Moon  system  [25,  84],  lunar  periodic  orbits 
[25,  84],  and  orbit  transfers  using  electric  propulsion  and  a  solar  sail  [85]. 

There  is  comparatively  less  research  in  optimal  trajectory  design  for  spacecraft  in 
low  Earth  orbits  with  the  purpose  to  achieve  some  effect  or  effects  on  the  Earth’s  surface. 
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Guelman  and  Kogan  implemented  a  maneuvering  strategy  to  determine  optimal  trajectories 
that  overfly  a  specified  number  of  ground  sites  in  a  given  time  using  electric  propulsion 
[34].  Co  et  al.  investigated  the  effects  of  propulsion  method,  orbit  type,  and  thrust  time 
on  maximizing  distance  between  a  maneuvering  satellite  and  a  non-maneuvering  reference 
satellite  [35].  Abdelkhalik  and  Mortari  implemented  a  GA  to  determine  an  optimal  orbit 
to  visit  multiple  ground  sites  in  a  specified  time  frame  [32].  Kim  et  al.  used  a  GA  to  find 
the  optimal  orbit  to  minimize  average  revisit  time  over  a  specific  ground  target  in  a  finite 
number  of  days  [33]. 

23.3.2  Hybrid  Optimal  Control 

HOC  problems  consist  of  combinations  of  categorical  variables  and  continuous 
variables.  HOC  algorithms  are  particularly  interesting  because  they  enable  high  level 
autonomous  decision  making  and  can  be  applied  to  a  variety  of  real  world  engineering 
problems,  which  result  from  a  mixture  of  logical  decisions  and  continuous  dynamics  [86]. 

Recent  research  on  the  use  of  HOC  in  spacecraft  trajectory  optimization  [28- 
31,  87,  88]  has  focused  on  bi-level  HOC  algorithms  with  multiple  uses  for  the  categorical 
variables.  One  use  for  the  categorical  variables  is  to  select  a  planet  to  fly-by  or  an 
asteroid  to  rendezvous  with  [28-31].  A  second  use  for  the  categorical  variables  is  to 
define  the  number  and  sequence  of  the  maneuvers  to  be  performed  [30,  31].  Finally, 
recent  research  has  focused  on  using  the  categorical  variables  to  determine  the  type  of 
maneuvers  to  be  performed,  in  addition  to  their  number  and  sequence  [87,  88].  In  all 
cases,  the  structure  defined  by  the  categorical  variables  completely  defines  the  inner-loop 
optimization  problem. 

Conway  et  al.  [28]  formulated  an  HOC  problem  in  the  solution  of  a  three  asteroid 
interception  mission.  A  maneuvering  spacecraft  with  impulsive-only  thrust  capability  was 
required  to  intercept  three  of  a  possible  eight  asteroids  with  minimum  fuel.  The  authors 
compared  a  bi-level  algorithm  with  an  outer-loop  GA  and  an  inner-loop  method  applying 
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direct  transcription  with  Runge-Kutta  implicit  integration  (DTRK)  to  a  bi-level  algorithm 
employing  a  branch  and  bound  (B&B)  outer- loop  and  a  GA  inner-loop.  Complete 
enumeration  was  used  to  determine  the  optimal  sequence  and  cost.  The  GA-DTRK 
found  the  optimal  solution  while  requiring  only  a  fraction  of  the  number  of  cost  function 
evaluations  required  for  complete  enumeration  of  the  problem  space.  The  B&B-GA  located 
similar  solutions  to  those  found  by  the  GA-DTRK  algorithm  with  even  fewer  cost  function 
evaluations. 

Wall  and  Conway  [29]  examined  the  low-thrust  version  of  the  minimum  fuel  asteroid 
rendezvous  problem  defined  in  [28].  The  authors  used  a  shape-based  approximation  to 
generate  feasible  low-thrust  trajectories  with  defined  boundary  conditions.  They  compared 
the  performance  of  a  bi-level  HOC  algorithm  with  a  B&B  outer-loop  solver  coupled  with  a 
GA  inner-loop  to  that  of  a  GA  outer-loop  coupled  with  an  inner-loop  GA.  Once  the  outer- 
loop  algorithms  terminated,  the  best  trajectories  found  by  each  hybrid  algorithm  were  used 
as  initial  guesses  for  a  DTRK  method.  [29]  implemented  a  bi-level  GA-GA  algorithm  to 
solve  a  larger  asteroid  rendezvous  in  which  a  spacecraft  must  rendezvous  with  one  asteroid 
in  each  of  four  groups  of  asteroids.  Once  again,  the  best  solutions  generated  by  the  GA-GA 
algorithm  with  shape-based  approximation  were  used  as  initial  guesses  for  a  more  accurate 
DTRK  method.  The  solutions  found  with  the  GA-GA  algorithm  very  nearly  approximated 
the  optimal  solutions  identified  by  the  DTRK  and  required  significantly  less  computational 
time  to  generate. 

Englander  et  al.  [30]  used  a  bi-level  HOC  algorithm  to  optimize  interplanetary 
transfers  with  unknown  locations,  numbers,  and  sequences  of  en-route  flybys.  The  outer- 
loop  utilized  a  GA  to  determine  the  number,  location,  and  sequence  of  fly-bys,  while  the 
inner-loop  employed  a  combination  of  PSO  and  DE  to  optimize  the  variables  corresponding 
to  the  sequences  generated  by  the  outer-loop.  The  authors  applied  this  algorithm  to  three 
problems:  an  impulsive  multi  gravity  assist  (MGA)  transfer  from  Earth  to  Jupiter,  an 
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impulsive  MGA  transfer  from  Earth  to  Saturn,  and  an  impulsive  multi  gravity  assist  with 
deep  space  maneuvers  (MGADSM)  transfer  from  Earth  to  Saturn. 

Englander  et  al.  [31]  extended  the  work  of  [30]  by  adding  a  capability  to  model 
low-thrust  trajectories.  They  utilized  a  bi-level  algorithm  consisting  of  an  outer-loop 
GA  coupled  with  an  inner-loop  monotomic  basin  hopping  (MBH)  algorithm.  The  result 
from  the  MBH  algorithm  was  used  as  an  initial  guess  in  the  solution  of  a  Sims-Elanagan 
transcription  algorithm  used  to  generate  low-thrust  trajectories.  The  authors  applied  this 
algorithm  to  generate  optimal  trajectories  for  an  Earth  to  Jupiter  transfer  employing  nuclear 
electric  propulsion,  an  early  proposal  for  the  BepiColombo  mission  to  Mercury,  and  a  solar- 
electric  mission  from  Earth  to  Uranus. 

Chilan  and  Conway  [87]  introduced  a  new  use  for  HOC  in  spacecraft  trajectory 
optimization  by  using  the  categorical  variables  to  define  the  number,  types,  and  sequence  of 
maneuvers  to  be  performed  between  defined  boundary  conditions.  They  implemented  a  bi¬ 
level  HOC  algorithm  with  a  GA  outer- loop  solver  combined  with  a  NEP  inner- loop  solver. 
The  inner-loop  solver  was  seeded  with  an  initial  guess  using  feasible  region  analysis  and 
a  conditional  penalty  (CP)  method.  They  demonstrated  the  effectiveness  of  the  algorithm 
by  solving  a  minimum-fuel,  time-fixed  rendezvous  between  circular  orbits  originally  posed 
by  Prussing  and  Chui  [89].  The  algorithm  proposed  in  [87]  generated  the  optimal  solution 
found  by  Colasurdo  and  Pastrone  [90]. 

In  a  subsequent  work,  Chilan  and  Conway  [88]  used  a  bi-level  HOC  employing  a 
GA  outer-loop  solver  coupled  with  an  NEP  inner-loop  solver  which  was  seeded  by  a 
GA  employing  the  CP  method.  They  applied  the  algorithm  to  the  time-fixed  rendezvous 
problem  posed  by  [89]  and  found  a  low-thrust  trajectory  which  had  a  lower  cost  than,  but 
was  analogous  to  the  best  impulsive  solution  found  by  [90].  [88]  applied  the  same  bi-level 
HOC  to  find  an  optimal  minimum  fuel,  free  final  time  trajectory  from  Earth  to  Mars. 
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Yu  et  al.  [91]  developed  a  bi-level  HOC  algorithm  to  determine  optimal  trajectories 
for  several  variants  of  a  GEO  debris  removal  problem.  They  compared  the  performance  of 
a  simulated  annealing  (SA)  outer  solver  coupled  with  a  GA  to  that  of  an  exhaustive  search 
coupled  with  a  GA  to  solve  the  inner-loop  problem.  Additionally,  the  authors  developed 
a  so-called  Rapid  Method  for  the  outer-loop  solver  and  found  that  it  generated  similar 
solutions  to  that  of  the  SA  outer-loop  solver,  but  required  much  less  computational  time. 

2.4  Summary 

This  chapter  provided  background  information  on  research  relevant  to  this  disserta¬ 
tion,  specifically  on  research  in  the  field  of  spacecraft  trajectory  optimization.  While  the 
field  is  quite  extensive,  there  is  no  current  research  on  maneuvers  which  enable  or  enhance 
satellite  resiliency.  The  purpose  of  this  dissertation  is  to  develop  these  types  of  maneu¬ 
vers  and  investigate  methods  that  facilitate  their  autonomous  optimization.  In  particular, 
this  dissertation  will  develop  resiliency  maneuvers  which  can  be  optimized  using  the  meth¬ 
ods  covered  in  this  literature  review.  Specifically,  EAs  and  metaheuristics  will  be  utilized 
in  conjunction  with  Eambert  targeting  algorithms,  shape-based  trajectory  approximation, 
NEP  problem  solvers,  and  bi-level  HOC  to  produce  optimal  and  near-optimal  resiliency 
maneuvers. 
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III.  Responsive  Theater  Maneuvers  via  Particle  Swarm  Optimization 


3.1  Abstract 

This  research  investigates  the  performance  of  the  particle  swarm  optimization 
algorithm  in  the  solution  of  responsive  theater  maneuvers,  introduced  here  for  the  first 
time.  The  responsive  theater  maneuver  is  designed  to  alter  a  spacecraft’s  arrival  position  as 
it  overflies  a  hazardous  geographic  region  while  still  meeting  sensor  range  constraints.  The 
maneuver  places  the  satellite  on  an  exclusion  ellipse  centered  at  the  spacecraft’s  expected 
arrival  position  at  the  expected  time  of  entry  into  the  hazardous  region.  A  global  particle 
swarm  optimization  algorithm  is  shown  to  generate  optimal  solutions  for  the  single  pass 
responsive  theater  maneuver  scenario  in  shorter  time  frames  than  local  particle  swarm 
variants,  a  genetic  algorithm,  and  a  parameter  search.  The  global  particle  swarm  algorithm 
is  then  shown  to  generate  consistent  performance  in  the  solution  of  single,  double,  and 
triple  pass  responsive  theater  maneuver  scenarios  for  various  size  exclusion  ellipses. 
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3.2  Nomenclature 


Qe 

be 


C\ 


C2 


Sbest 


gk 


hk 


J 


Sbest  ^  ^best^  Phest 

Jpis) 

he  St 

m 


n 

P 


Pbest 

Rak 

Re 


R 


Pk 


Rfnax^  Rmin 


rk 


semimajor  axis  of  exclusion  ellipse,  km 

semiminor  axis  of  exclusion  ellipse,  km 

swarm  cognitive  parameter 

swarm  social  parameter 

global  best  position  in  the  solution  space 

unit  vector  perpendicular  to  Vk  and  /ijt  at  k’^  expected  time  of  entry  into 
exclusion  zone 

expected  angular  momentum  vector  of  satellite  at  time  of  entry  into 

exclusion  zone,  krn^/ sec 

cost  of  nonlinear  function  to  be  optimized 

lowest  cost  associated  with  the  swarm,  neighborhood,  and  particle 
cost  associated  with  a  particle  at  the  s‘^  iteration 
neighborhood  best  position  in  the  solution  space 
number  of  particles  in  the  swarm 

number  of  design  variables  in  the  nonlinear  function  to  be  optimized 

period  of  the  initial  orbit,  sec 

particle  best  position  in  the  solution  space 

orbit  apogee  radius  after  the  kf’^  maneuver,  km 

distance  from  expected  position  of  the  spacecraft  to  the  actual  position 
of  the  spacecraft,  km 

orbit  perigee  radius  after  the  k^^  maneuver,  km 
maximum  and  minimum  allowable  orbital  radius,  km 
expected  position  vector  of  satellite  at  k'^  time  of  entry  into  exclusion 
zone,  km 

actual  position  vector  of  spacecraft  at  k‘^  time  of  entry  into  exclusion 
zone,  km 
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ro 

S 

Tk 

tk 

h 

Vpis) 

■ 

'^max^  ^min 

Vk,  v; 


Vkt 


Vo 

Xp{s) 

r'  r' 
■^max’’  -^min 

X 

<p,  A 


dk 

Center 


An 

An 


position  vector  at  the  instant  just  before  the  impulse,  km 
initial  position  vector,  km 

Solution  space  encompassing  all  n  design  variables 
time  of  flight  of  the  k^^  maneuver,  sec 
expected  k*^  time  of  entry  into  exclusion  zone,  sec 
initial  time,  sec 

n-dimensional  velocity  vector  of  the  particle  at  the  5'^  iteration 
upper  and  lower  bounds  on  the  velocity  of  the  design  variable 
expected  and  actual  velocity  vector  of  satellite  at  k*'^  time  of  entry  into 
exclusion  zone,  km/ sec 

velocity  vectors  at  the  instant  just  before  and  just  after  the  k‘^ 

impulse,  km!  sec 

initial  velocity  vector,  km/ sec 

n-dimensional  position  vector  of  the  particle  at  the  s'^  iteration 
upper  and  lower  bounds  on  the  position  of  the  design  variable 
swarm  constriction  factor 
geocentric  latitude  and  longitude,  ° 

angle  defining  position  of  spacecraft  on  the  k'’^  exclusion  ellipse,  rad 
true  anomaly  of  the  spacecraft  as  it  enters  the  latitude  band  of  the 
exclusion  zone 

Earth’s  gravitational  parameter,  km^ ! sec^ 
velocity  vector  of  the  k'’^  maneuver,  km  j  sec 
cost  of  the  k'^  maneuver,  m/ sec 
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3.3  Introduction 


In  recent  years,  the  space  domain  has  moved  from  an  uncontested  to  a  contested 
environment  in  which  access  to  and  the  use  of  space  can  no  longer  be  taken  for  granted. 
In  light  of  this  shifting  paradigm,  the  United  States  Department  of  Defense  (DoD)  released 
a  National  Security  Space  Strategy  (NSSS)  in  2011  which  promotes  “cost-effective” 
spacecraft  protection  and  resilience  [2].  The  NSSS  defines  resilience  as  “the  ability  of 
an  architecture  to  support  functions  necessary  for  mission  success  in  spite  of  adverse 
conditions.  An  architecture  is  more  resilient  if  it  can  provide  these  functions  with  higher 
probability,  shorter  periods  of  reduced  capability,  and  across  a  wider  range  of  scenarios  and 
conditions”  [4]. 

Increased  satellite  maneuverability  enhances  resilience  by  enabling  operation  in 
hazardous  conditions.  A  new  set  of  maneuvers,  introduced  here  as  responsive  theater 
maneuvers  (RTMs),  are  proposed  to  enhance  resilience  for  friendly  space  assets  by 
introducing  uncertainty  while  still  meeting  sensor  range  to  collection  target  requirements. 

3.4  Background 

The  field  of  optimal  spacecraft  trajectories  is  extensive  and  well  researched.  Conway 
[51]  authored  a  survey  of  known  solution  methods  as  well  as  an  overview  of  the  most 
recent  developments  in  the  field  of  spacecraft  trajectory  optimization.  According  to  [51], 
the  critical  limitation  of  many  commonly  used  optimization  techniques  is  the  need  for  a 
suitable  initial  guess.  Even  when  a  suitable  initial  guess  is  provided,  these  techniques 
converge  to  a  local  optimal  solution  in  the  neighborhood  of  the  guess.  Conway  specifically 
mentions  the  advantages  of  evolutionary  algorithms  because  they  don’t  suffer  from  these 
limitations  and  are  more  likely,  albeit  not  guaranteed,  to  find  the  global  optimal  solution 
[51]. 

One  such  evolutionary  algorithm  is  the  particle  swarm  optimization  (PSO)  algorithm, 
initially  developed  by  Eberhart  and  Kennedy  [52,  53] .  The  swarm  is  initialized  by  randomly 
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assigning  each  particle  a  position  and  velocity  vector  in  the  solution  space.  The  costs 
associated  with  the  positions  of  each  particle  are  used  to  update  the  best  position  visited  by 
swarm  gbest  and  the  best  position  ever  visited  by  that  specific  particle  pbest-  These  values 
are  then  used  to  update  each  particle’s  velocity  and  position  vectors  for  the  next  iteration. 
The  process  is  repeated  until  a  defined  convergence  criteria  is  met  or  a  maximum  number 
of  iterations  is  reached. 

Eberhart  and  Kennedys’  initial  research  showed  that  the  PSO  algorithm  described 
above  (known  as  GBEST)  had  a  tendency  to  become  trapped  in  local  extrema  and  they 
developed  a  different  version  (known  as  EBEST)  in  which  each  particle  only  had  access  to 
the  best  positions  visited  by  its  nearest  neighbors  [52].  Eberhart  and  Shi  found  that  EBEST 
is  less  likely  to  converge  to  local  minima  than  GBEST,  but  generally  takes  more  iterations 
to  converge  [54]. 

Shi  and  Eberhart  [55]  introduced  the  concept  of  an  inertia  weight,  which  is  meant 
to  balance  the  global  vs  local  search  capability  of  the  PSO.  Clerc  [56]  and  Clerc  and 
Kennedy  [57]  introduced  a  constriction  factor,  which  is  designed  to  ensure  the  swarm 
converges  rather  than  allowing  particles  to  tend  towards  the  boundaries  of  the  solution 
space.  Eberhart  and  Shi  [58]  compared  the  performance  of  a  PSO  using  an  inertia  weight 
to  that  of  a  PSO  using  a  constriction  factor  on  five  benchmark  problems  and  discovered  that 
the  best  approach  is  to  use  the  constriction  factor  while  defining  a  maximum  velocity  for 
each  variable  equal  to  its  dynamic  range  in  the  solution  space.  Zhang  et  al.  [60]  investigated 
the  effect  of  the  constriction  factor  on  particle  swarm  performance.  They  noted  that  the  sum 
of  the  cognitive  and  social  parameters  should  be  between  4.1  and  4.2  for  high  dimensional 
problems  and  4.05  and  4.3  for  lower  dimensional  problems  [60]. 

Penalty  functions,  which  assign  an  additional  cost  to  any  particle  that  violates  the 
constraints,  are  the  most  commonly  used  constraint  handling  technique.  Authors  have 
researched  the  effectiveness  of  different  types  of  penalties  including:  static  penalty  methods 


40 


[79],  dynamic  penalty  methods  [75,  92],  adaptive  penalty  methods  [77,  78],  and  the  death 
penalty  method  [73,  74].  Previous  research  has  shown  that  penalty  functions  must  be  tuned 
to  obtain  the  best  results  for  each  specific  problem  and  the  relative  magnitude  of  the  penalty 
must  be  considered  in  each  case  [72,  79,  80]. 

The  use  of  metaheuristics/evolutionary  algorithms  to  solve  spacecraft  trajectory 
optimization  problems  has  increased  dramatically  in  recent  years.  The  vast  majority  of 
research  in  the  field  has  focused  on  finding  optimal  solutions  to  a  variety  of  interplanetary 
trajectories  and  missions  [8-25].  Several  authors  have  also  implemented  heuristics  to  solve 
rendezvous  and  docking  trajectory  problems.  Luo  et  al.  applied  a  hybrid  genetic  algorithm 
to  solve  a  minimum-impulsive  minimum-time  rendezvous  with  constraints  in  the  Clohessy- 
Wiltshire  (CW)  frame  [26].  Stupik  et  al.  used  a  PSO  to  solve  a  continuous  thrust  minimax 
pursuit/evasion  problem  in  the  CW  frame  where  a  target  spacecraft  is  trying  to  maximize 
the  rendezvous  time  as  a  pursuer  spacecraft  is  trying  to  minimize  the  rendezvous  time  with 
the  target  [27]. 

Additional  researchers  studied  different  types  of  trajectory  optimization  problems 
using  PSO.  These  include  optimal  impulsive  transfers  between  several  different  orbit 
types  [25,  81,  82],  impulsive  and  finite  thrust  rendezvous  trajectories  [83],  Lyapunov 
orbits  around  the  Lagrange  points  in  the  Earth-Moon  system  [25,  84],  lunar  periodic  orbits 
[25,  84],  and  orbit  transfers  using  electric  propulsion  and  a  solar  sail  [85]. 

There  is  comparatively  less  research  in  optimal  trajectory  design  for  spacecraft  in 
low  Earth  orbits  with  the  purpose  to  achieve  some  effect  or  effects  on  the  Earth’s  surface. 
Guelman  and  Kogan  implemented  a  maneuvering  strategy  to  determine  optimal  trajectories 
that  overfly  a  specified  number  of  ground  sites  in  a  given  time  using  electric  propulsion 
[34].  Co  et  al.  investigated  the  effects  of  propulsion  method,  orbit  type,  and  thrust  time 
on  maximizing  distance  between  a  maneuvering  satellite  and  a  non-maneuvering  reference 
satellite  [35].  Abdelkhalik  and  Mortari  implemented  a  genetic  algorithm  (GA)  to  determine 
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an  optimal  orbit  to  visit  multiple  ground  sites  in  a  specified  time  frame  [32] .  Kim  et  al.  used 
a  GA  to  find  the  optimal  orbit  to  minimize  average  revisit  time  over  a  specific  ground  target 
in  a  finite  number  of  days  [33]. 

The  purpose  of  this  research  is  to  extend  the  field  of  spacecraft  trajectory  optimization 
problems  delivering  ground  effects  to  include  maneuvers  which  enhance  resiliency  for 
satellites  operating  over  potentially  hazardous  regions.  RTM  are  designed  to  enhance 
resiliency  by  altering  a  spacecraft’s  arrival  position  from  its  predicted  position  as  it  enters 
a  specified  geographic  region. 


3.5  Methodology 

Each  pass  over  the  specified  geographic  region  k  of  the  RTM  problem  has  two  design 
variables  corresponding  to  the  optimal  departure  and  arrival  location  of  the  maneuver 
resulting  in  a  total  of  n  =  2k  design  variables.  The  acceptable  bounds  on  each  design 
variable  define  the  solution  space  5  and  the  total  cost  of  the  maneuver  J  is  the  sum  of  the 
cost  of  the  maneuvers  required  for  each  pass. 

The  PSO  developed  below  is  based  on  the  work  of  several  previous  authors  [25,  55- 
57,  81,  84,  93].  It  has  a  total  of  m  particles  and  each  particle’s  position  Xp  and  velocity  Vp 
in  5  are  n-dimensional  vectors  where  the  dimension  of  each  vector  corresponds  to  the 
design  variable: 


Xp  =  [xp,  Xp, . . . ,  Xp] 
Vp  =  I^Vp,  Vp, . . . ,  Vp] 


(3.1) 


The  dimension  of  each  particle’s  position  vector  x’  is  bounded  by  the  lower  and 


upper  limits  of  the  design  variable  and  x^^^  respectively.  Similarly,  the  dimension 


th 


of  each  particle’s  velocity  vector  v‘  is  subject  to  an  upper  bound  =  x; 
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max 


x‘.  and  a 
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(3.2) 
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The  swarm  is  initialized  sueh  that  eaeh  partiele’s  position  and  veloeity  is  uniformly 
randomized  in  the  solution  spaee  defined  by  these  bounds.  The  eost  assoeiated  with  the 
position  of  eaeh  partiele  Jp  (s)  is  evaluated  at  eaeh  iteration  5  along  with  the  eonstraints.  If 
any  of  the  eonstraints  are  violated,  then  Jp  (s)  is  set  equal  to  infinity.  If  Jp  (5)  is  less  than 
the  lowest  eost  assoeiated  with  the  partiele  over  the  previous  5  -  1  iterations  [jp^^,}j,  then 
Jp^^^^  is  set  equal  to  Jp  (s)  and  the  best  position  ever  visited  by  the  partiele  Pbest  is  updated 
to  the  eurrent  partiele  position  Xp  (5). 

The  veloeity  of  eaeh  partiele  at  the  iteration  Vp  (s)  is  a  funetion  of  the  position  and 
veloeity  of  that  partiele  at  the  previous  iteration,  as  well  as  Pbesf  The  veloeity  update  for 
the  global  version  of  the  PSO  is  also  dependent  on  gbest,  whieh  is  the  best  position  visited 
by  the  swarm  so  far.  The  veloeity  update  equation  for  the  global  PSO  algorithm  used  for 
the  purposes  of  this  researeh  is  shown  in  Equation  3.4,  where  Ci  is  the  eognitive  parameter, 
C2  is  the  soeial  parameter,  and 


is  the  eonstrietion  faetor  with  0  =  ci  +  C2.  Additionally,  z\  and  zi  are  distinet  uniformly 
distributed  random  numbers  between  zero  and  one: 

Vp  (s)  =  X  [Vp  (■^  -  1)  +  Cizi  [pbest  -Xp(s-  1))  +  C2Z2  {gbest  -Xp(s-  1))]  (3.4) 

The  veloeity  update  for  the  loeal  version  of  the  PSO  varies  slightly  from  the  global 
version  beeause  eaeh  partiele  only  shares  information  with  its  q  adjaeent  neighbors  on 
either  side,  where  2q  is  the  neighborhood  size.  At  the  iteration,  Jp  (5)  is  eompared  to 
the  lowest  eost  ever  aehieved  by  any  partiele  in  its  neighborhood  over  the  previous 
iterations.  If  Jp  (s)  <  then  is  set  equal  to  Jp  (s)  and  the  best  position  ever  visited 
by  any  partiele  in  the  neighborhood  Ibest  is  set  equal  to  Xp  (s).  The  veloeity  update  for  the 
loeal  PSO  variant  used  in  this  researeh  is  shown  in  Equation  3.5: 

Vp  (s)  =  X  [Vp  (5  -  1)  +  Ciri  {pbest  -Xp(s-  1))  +  C2r2  {hest  -Xp(s-  1))]  (3.5) 
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If  the  component  of  the  velocity  is  outside  the  bounds  defined  in  Equation  3.2,  it 
is  reset  to  the  closest  boundary.  The  position  of  each  particle  at  the  iteration  is  updated 
according  to  Equation  3.6,  regardless  of  the  PSO  variant: 

X,{s)  =  X,{s-l)  +  Vp{s)  (3.6) 

Similarly,  any  component  of  Xp  outside  the  bounds  defined  in  Equation  3.2  is  reset 
to  the  nearest  boundary.  This  process  is  repeated  until  a  specified  convergence  criteria  is 
achieved  or  until  a  maximum  number  of  iterations  is  reached. 

3.6  Responsive  Theater  Maneuvers 

RTMs  require  a  maneuver  in  order  to  increase  the  unpredictability  of  a  spacecraft  as  it 
flies  over  a  hazardous  geographic  region  on  the  Earth,  called  the  exclusion  zone  and  defined 
by  latitude  {(fimin,  4>max)  and  longitude  {Xmin,  ^max)  bands.  These  maneuvers  are  constrained 
such  that  the  spacecraft  must  arrive  on  an  exclusion  ellipse  at  its  expected  time  of  entry  into 
the  exclusion  zone. 

3.6.1  Single  Pass  Maneuvers 

The  satellite  begins  in  an  Earth  orbit  at  initial  time  to  with  Earth-centered,  inertial 
position  and  velocity  vectors,  tq  and  Vq,  respectively.  Additionally,  the  Earth  is  assumed 
to  be  a  perfect  sphere  and  the  spacecraft  is  subject  only  to  two-body  Keplerian  forces.  As 
a  result,  the  geocentric  longitude  A  and  latitude  (p  can  be  computed  at  any  time  t  using  the 
current  position  vector  and  the  Greenwich  Mean  Time  (GMT).  Eor  simplicity,  GMT  at  to  is 
assumed  zero. 

The  expected  satellite  entry  state  into  the  exclusion  zone  state  consists  of  the  time 
of  entry  t\,  the  position  vector  at  entry  ri,  and  the  velocity  vector  at  entry  Vi.  The  two- 
body  and  spherical  Earth  assumptions  make  it  possible  to  analytically  determine  the  true 
anomaly  of  the  spacecraft  Venter  as  it  enters  the  exclusion  zone  latitude  band.  Eet  ^  be 
the  argument  of  latitude  corresponding  to  the  point  at  which  the  latitude  band  defined  by 
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{(pmin,  (f>max)  is  entered.  If  0  <  <  ^max  <  ^  <  n/2  (where  ^  denotes  the  orbit  inclination) 


and  0  <  ^  <  7r/2,  then 


sinC  = 


sin  (pmin 

sin^ 


and  the  true  anomaly  v enter  is  given  by 


'Center  —  ^  ^ 


(3.7) 


(3.8) 


The  true  anomaly  Vemer  corresponds  to  the  inertial  position  and  velocity  vectors 
denoted  with  renter  and  Venter,  respectively.  Equations  (5.10)  and  (3.8)  are  to  be  modified  if 
the  previously  reported  inequalities  are  not  satisfied,  if  the  exclusion  latitude  band  is  entered 
while  the  spacecraft  is  traveling  toward  the  equatorial  plane  (i.e.  when  njl  <  ^  <  n),  or  in 
the  presence  of  a  retrograde  orbit.  Once  Venter  has  been  obtained,  the  first  time  at  which  the 
satellite  enters  the  latitude  band  tenter  is  found  from  the  solution  of  Kepler’s  equation,  under 
the  assumption  that  the  true  anomaly  at  to  is  known. 

All  subsequent  entries  into  the  latitude  band  occur  one  orbital  period  after  the  previous 
entry.  Further,  the  longitude  of  the  spacecraft  at  tenter  is  found  using  the  entry  time  and  the 
inertial  position  vector  corresponding  to  Venter-  A  similar  process  is  used  to  determine  the 
true  anomaly  Vgxiu  time  texu,  and  the  longitude  of  the  spacecraft  when  it  exits  the  latitude 
band. 

The  spacecraft  enters  the  exclusion  zone  between  tenter  and  tgxit  in  two  instances.  The 
first  occurs  if  Amin  ^  Aenter  ^  Amax  and  implies  that  the  true  anomaly  upon  entry  into 
the  exclusion  zone,  vi,  is  equal  to  Venter-  The  second  case  occurs  when  Aenter  <  Amin  and 
dmm  <  '^exit-  This  sccnario  implies  Venter  <  Vi  <  Vexit  and  requires  interpolation  to  determine 
vi.  The  satellite’s  expected  entry  state  into  the  exclusion  zone  can  be  found  from  vi. 

The  expected  specific  angular  momentum  vector  of  the  orbit  h  i  is  defined  by  ri  and 
vi: 

/ii  =  n  X  vi  (3.9) 
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Additionally,  a  unit  vector  perpendicular  to  Vi  and  hi  is  defined  as 


Vi  X  hi 
Ivill/iil 


(3.10) 


The  exclusion  zone  is  defined  by  an  ellipse  with  semimajor  axis  Ug  and  semiminor  axis 
bg.  It  is  centered  at  ri  and  oriented  such  that  Ug  is  aligned  with  Vi.  The  satellite  must  arrive 
at  some  point  on  the  exclusion  ellipse  rather  than  ri  at  time  0.  The  first  variable  6i,  is  an 
angle  which  defines  the  satellite’s  location  on  the  exclusion  ellipse  and  is  measured  from 
Vi  in  the  direction  of  The  distance  from  the  ellipse  center  to  any  point  on  the  ellipse  is 
defined  by  Ug,  bg,  and  6i,  as  shown  in  Equation  (4.3): 


Rg 


ttgbg 


^bl  cos^  6 1  +  a\  sin^  6i 


(3.11) 


The  position  where  the  intercept  will  take  place  on  the  ellipse  is  then  defined  in  the 
inertial  frame  as  shown  in  Equation  (4.2): 


Tj  =  ri +7?^cos6'i^ +7?<,sin6'i^i  (3.12) 

|vil 

A  second  variable  Ti  defines  how  many  seconds  in  advance  of  ti  the  satellite  will 
perform  an  impulsive  maneuver  that  will  deliver  it  to  r  j  at  ti .  It  is  assumed  that  T i  must 
be  less  than  or  equal  to  one  orbital  period  of  the  initial  orbit  and  greater  than  1200  seconds 
to  allow  the  spacecraft  time  to  prepare  for  data  collection  as  it  passes  over  the  exclusion 
zone.  The  position  and  velocity  vectors  at  the  instant  before  the  maneuver  are  ri-  and  Vi-, 
respectively.  The  orbital  geometry  is  depicted  in  Eigure  3.1. 


The  velocity  vector  of  the  maneuver  that  will  take  the  spacecraft  from  the  state  defined 
by  ri-  and  Vi-  to  in  Ti  s  is  AFi,  and  are  found  by  solving  the  well  known  Eambert’s 
problem. 

The  new  orbit  must  have  an  apogee  radius  Ray  less  than  or  equal  to  some  maximum 
radius  Rmax  as  well  as  a  perigee  radius  Rp^  greater  than  or  equal  to  some  minimum  radius 
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Figure  3.1:  Single  pass  RTM  intereept  geometry 


R,nin  in  order  for  the  spaeeeraft  to  perform  adequate  data  eolleetion  for  the  duration  of  its 
mission. 

3.6.2  Mulitple-Pass  Maneuvers 

The  solution  method  for  the  single  pass  RTM  problem  ean  be  extended  to  optimize  an 
R-pass  RTM  problem  over  the  exelusion  zone  by  reinitializing  the  initial  eonditions  after 
eaeh  maneuver,  but  the  number  of  optimization  variables  inereases  by  two  for  eaeh  pass 
over  the  exelusion  zone. 

Consider  a  double  pass  RTM  problem.  The  algorithm  begins  with  initial  eonditions 
(ro,  Vo,  to)  and  determines  the  arrival  state  into  the  exelusion  zone  defined  by  ti,  ri,  and  Vi. 
The  variables  Ti  and  6i  determine  the  eost  of  the  first  maneuver  AVi.  They  also  define  the 
post  maneuver  position  and  veloeity  veetors  of  the  spaeeeraft  at  ti,  /**  and  v\,  respeetively, 
whieh  beeome  the  initial  eonditions  for  the  seeond  pass  over  the  exelusion  zone.  The 
algorithm  identifies  the  seeond  time  the  spaeeeraft  will  fly  over  the  exelusion  zone  t2,  as 
well  as  the  expeeted  position  and  veloeity  veetors  upon  arrival  r2  and  V2,  respeetively.  The 
variable  T2  determines  the  time  of  flight  needed  to  make  the  maneuver,  and  the  variable  62 
determines  the  spaeeeraft’s  intereept  point  on  the  exelusion  ellipse.  This  information  ean 
then  be  used  to  determine  the  eost  of  the  seeond  maneuver  Ay2-  A  double  pass  maneuver 


47 


has  four  design  variables:  Ti,  6i,  T2,  and  62  with  a  eost  J  =  AVi  +  AV2.  This  proeess  ean 
be  extended  to  n  pass  maneuvers  as  needed. 

3.7  Numerical  Results 

3.7.1  Comparison  of  Optimization  Tools  for  Single  Pass  RTM  Problem 

The  first  objeetive  of  this  researeh  was  to  identify  the  most  effieient  method  to  optimize 
RTM  problems.  The  single  pass  RTM  problem  was  used  as  a  test  funetion  to  determine  the 
effeetiveness  and  effieieney  of  PSO  algorithms  in  eomparison  to  a  genetie  algorithm  and 
a  simple  parameter  seareh.  Additionally,  this  problem  was  used  to  identify  a  eoneept  of 
operations  for  employing  evolutionary  algorithms  to  generate  optimal  solutions  for  RTM 
seenarios.  Ten  algorithms  (four  global  global  PSO  (PSOG)  of  varying  swarm  size,  four 
loeal  PSO  (PSOL)  algorithms  with  varying  swarm  size,  the  genetie  algorithm  toolbox  in 
MATLAB,  and  a  simple  parameter  seareh)  were  used  to  solve  the  single  pass  RTM  problem 
shown  in  Equation  (4.7),  where  P  is  the  period  of  the  initial  orbit.  The  parameter  seareh 
was  performed  in  inerements  of  0.5  s  and  0.001  rad  in  order  to  generate  results  with  the 
same  fidelity  as  seen  in  the  evolutionary  algorithms: 


(3.13) 


The  parameter  seareh  was  used  to  identify  the  global  optimal  solution  and  to  measure 
the  eonvergenee  sueeess  of  the  evolutionary  algorithms  for  the  single  pass  RTM  due  to 
its  two-dimensional  nature.  The  global  optimal  solution  for  the  single-pass  RTM  problem 
with  Oe  =  150  km  and  be  =  15  km  is  as  follows:  Ti  =  2877  s,  61  =  5.906  rad,  and 


48 


J  =  4.08255  m/s,  and  run  time  =  6934.03  s.  The  three-dimensional  response  surfaee  is 
shown  in  Figure  3.2.  Note  that  there  are  two  distinct  troughs  in  the  response  surface,  one 
of  which  corresponds  to  the  previously  mentioned  global  minimum,  and  another  which 
corresponds  to  a  local  minimum  approximately  0.04  m/s  greater  than  the  global  optimal 
solution.  The  shape  of  the  response  surface  illustrates  that  a  poor  initial  guess  would 
make  it  impossible  to  determine  the  global  optimal  solution  using  analytical  gradient-based 
methods. 


Tl(sec)  0^(rad) 

Figure  3.2:  Response  surface  for  single  pass  RTM  with  Ug  =  150  km  and  bg  =  15  km 

All  eight  PSO  algorithms  were  implemented  with  identical  cognitive  and  social 
parameters  (ci  =  C2  =  2.1).  The  global  versions  of  the  PSO  algorithm  employed  a  stopping 
condition  that  terminated  the  algorithm  when  the  best  cost  of  each  individual  particle 
was  within  le“^°  km/s  of  the  lowest  cost  of  the  swarm  The  local  versions  of  the 
PSO  terminated  in  the  same  circumstances  as  the  global  versions,  and  also  if  75%  of 
the  particles’  costs  were  within  le~^^  km/s  after  1000  iterations.  The  maximum  number 
of  iterations  for  all  PSO  variants  was  capped  at  7000.  The  genetic  algorithm  used  a 
population  size  of  50  and  a  crossover  rate  of  0.8.  Selection  was  accomplished  via  stochastic 
uniform  selection  and  five  elite  members  of  each  generation  were  automatically  selected 
for  the  next  generation.  Additionally,  each  member  of  the  first  generation  was  reinitialized 
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until  it  satisfied  the  constraints.  The  maximum  allowable  generations  parameter  was 
set  to  2000.  We  did  not  investigate  the  ideal  parameter  settings  for  the  GA;  it  is 
only  presented  here  to  demonstrate  that  it  produces  similar  results  to  the  PSO  variants. 
Each  evolutionary  algorithm  was  parallelized  on  a  machine  with  a  six  core,  2.9  GHz 
processor  and  run  20  times.  The  following  data  were  collected  to  measure  performance: 
cost,  iterations/generations  [minimum  (min);  maximum(max);  average  (avg)]  required 
for  convergence,  and  the  run  time  required  for  convergence.  The  performance  of  each 
algorithm  is  shown  in  Table  3.1. 


Table  3.1:  Comparison  of  optimization  algorithms  in  single  pass  RTM  problem 


Method 

Pop  Size 

Neighborhood 

Size 

J  {mj  sec) 

Min  Max 

Iterations/Generations 

Min  Max  Avg 

Run  Time  {sec) 

Min  Max  Avg 

Convergence 

Global  Local 

PSOG 

30 

- 

4.08254 

4.12261 

84 

979 

204.05 

4.93 

56.54 

12.48 

30% 

70% 

PSOG 

60 

- 

4.08254 

4.12261 

107 

433 

201.45 

6.88 

27.91 

13.04 

70% 

30% 

PSOG 

100 

- 

4.08254 

4.12261 

102 

722 

266.70 

7.00 

49.17 

18.20 

80% 

20% 

PSOG 

120 

- 

4.08254 

4.12261 

88 

1649 

319.05 

6.43 

119.45 

23.25 

90% 

10% 

PSOL 

30 

4 

4.08254 

4.12302 

273 

7000 

3650.10 

17.96 

504.32 

241.69 

65% 

15% 

PSOL 

60 

8 

4.08254 

4.12261 

235 

7000 

4181.70 

20.34 

690.56 

379.58 

75% 

5% 

PSOL 

100 

14 

4.08254 

4.08256 

384 

7000 

4160.55 

40.77 

855.51 

474.56 

95% 

- 

PSOL 

120 

18 

4.08254 

4.08255 

322 

7000 

2435.7 

46.13 

971.76 

329.11 

95% 

- 

GA 

50 

- 

4.08254 

4.12261 

17 

17 

17 

45.90 

224.81 

97.43 

55% 

15% 

The  PSOG  with  30  particles  had  the  fastest  average  convergence  time,  but  also 
demonstrated  the  lowest  global  convergence  rate.  The  PSOL  variants  with  sufficient  size 
provided  the  best  global  convergence  rate  and  avoided  the  local  minimum  solution  to  which 
all  other  algorithms  converged  at  least  once.  This  success,  however,  came  with  a  significant 
penalty  in  solution  time  relative  to  the  PSOG  variants  of  similar  size.  Both  the  PSOL 
variants  and  the  GA  were  significantly  slower  than  all  PSOG  in  terms  of  average  run  time. 
The  faster  convergence  for  smaller  swarm  sizes,  coupled  with  their  convergence  to  the 
global  minimum  over  the  course  of  20  runs,  led  to  the  conclusion  that  it  is  more  efficient 
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to  run  the  PSOG  several  times  than  to  run  other  algorithms  that  provide  more  consistent 
performance  but  take  much  longer  to  generate  a  solution.  It  is  important  to  note  that  the 
GA  was  essentially  an  off-the-shelf  model  that  was  not  tuned  or  studied  to  the  extent  of  the 
PSO  variants.  Further  investigation  should  indicate  that  the  performance  of  the  GA  could 
be  improved  for  this  problem. 

3.7.2  Single  Pass  Results 

The  PSOG  variant  with  30  particles  was  used  to  solve  several  cases  of  the  single  pass 
RTM  problem  using  the  same  initial  conditions  described  in  Equation  (4.7)  as  well  as  for  a 
circular  orbit  with  ro  =  [7300  0  0]  km  and  vo  =  [0  5.22507  5.22507]  km/s.  The  exclusion 
zone  for  all  cases  was  defined  as  {(pmin,  4>max)  =  (-10°,  10°)  and  (T^m,  3.max)  =  (-50°,  -10°). 
The  size  of  the  exclusion  ellipse  semimajor  axis  ranged  from  50  km  to  150  km  in  increments 
of  10  km,  with  be  =  O.la^.  The  constraints  were  defined  such  that  R^ax  =  tq  -i-  50  km  and 
Rmin  =  ?'o  -  50  km.  Each  case  was  run  20  times  using  the  same  workstation  described  in  the 
previous  section. 

In  all  cases,  the  PSO  converged  to  two  distinct  solutions.  The  difference  between  the 
lowest  cost  solutions  and  the  local  minimum  solutions  increased  with  increasing  exclusion 
ellipse  size,  with  a  maximum  of  0.040  m/s  for  ro  =  6800  km  and  a  maximum  of  0.034  m/s 
for  ro  =  7300  km.  These  differences  are  negligible  when  considering  the  control  capability 
of  real  world  thrusters.  The  lowest  costs  found  by  the  PSO  are  shown  in  Table  3.2  in  units 
of  m/s.  Eigures  3.3(a)  and  3.3(b)  show  the  maneuver  times  (Tj)  and  arrival  locations  {6i)  of 
the  lowest  cost  solutions  as  functions  of  exclusion  ellipse  size  for  the  case  with  ro  =  6800 
km.  These  figures  are  representative  of  the  results  seen  for  ro  =  7300  km. 

Eigure  3.3(b)  shows  the  optimal  arrival  location  on  the  exclusion  ellipse  is  always 
larger  than  n  rad,  which  implies  that  the  spacecraft  arrival  location  over  the  exclusion  zone 
is  lower  in  altitude  than  the  expected  arrival  location.  The  reduction  in  altitude  results  in 
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Table  3.2:  Optimal  cost  of  single  pass  RTM  problem  for  varying  exclusion  ellipse  sizes 


ajbe  (km) 

ro,  km 

(m/ sec) 

50/5 

60/6 

70/7 

80/8 

90/9 

100/10 

110/11 

120/12 

130/13 

140/14 

150/15 

6800 

AV 

1.365 

1.638 

1.910 

2.182 

2.454 

2.726 

2.998 

3.269 

3.541 

3.812 

4.083 

7300 

AV 

1.228 

1.473 

1.718 

1.962 

2.207 

2.451 

2.696 

2.940 

3.184 

3.428 

3.672 

2880 


100 

Exclusion  Ellipse  a  (km) 


150 


5.9068 
5.9066 
,  5.9064 
'  5.9062 
5.906 
5.9058 
5.9056 
5.9054 


50 


100 

Exclusion  Ellipse  a  (km) 


150 


(a)  Ti  as  a  function  of  exclusion  ellipse  size  (b)  0i  as  a  function  of  exclusion  ellipse  size 

Figure  3.3:  Optimal  design  variables  and  constraints  for  single  pass  RTM  as  functions  of 
exclusion  ellipse  size  (ro  =  6800  km) 


an  earlier  arrival  over  the  exclusion  zone  because  a  decrease  in  altitude  corresponds  to  an 
increased  angular  rate  around  the  Earth. 

The  cost  associated  with  the  RTM  increases  with  increasing  exclusion  ellipse  size. 
Unexpectedly,  the  cost  increases  proportionally  to  the  size  of  the  exclusion  ellipse. 
Equation  3.14  provides  a  method  for  estimating  the  cost  associated  with  maneuvering  to 
exclusion  ellipse  sizes  not  investigated  in  this  paper.  This  relationship  is  accurate  within 
0.0088  m/s  for  ro  =  6800  km  and  0.0098  m/s  for  ro  =  7300  km. 


ae2  AV2 


(3.14) 
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Another  important  result  is  the  relative  speed  of  the  PSOG  for  the  single  pass  RTM 
problem.  The  algorithm  eompleted  20  runs  in  less  than  five  min  for  all  cases  considered 
with  an  average  time  of  completion  of  201.43  s.  Table  3.5  in  the  Appendix  shows  the  run 
time  required  for  all  20  runs  of  each  case  as  well  as  the  global  convergence  rate. 

Figure  3.4  shows  the  ground  track,  predicted/actual  entry  locations,  and  the  exclusion 
ellipse  for  the  single  pass  RTM  problem  with  rg  =  6800  km  and  =  150  km.  These  results 
are  representative  of  those  seen  in  the  other  single  pass  RTM  with  varying  size  exclusion 
ellipses. 


-150  -100 


-50  0  50 

longitude  (deg) 


100  150 


-32.62  -32.6  -32.58-32.56-32.54-32.52  -32.5  -32.48 
longitude  (deg) 


(a)  Ground  track  of  maneuvering  spacecraft 


(b)  Spacecraft  arrival  in  exclusion  zone 


(kin) 


(c)  Spacecraft  arrival  on  exclusion  ellipse 

Figure  3.4:  Optimal  solution  for  single  pass  RTM  maneuver  with  =  150  km,  bg  =  15  km 
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3.7.3  n-Pass  RTM 


3.7.3. 1  Double  Pass  RTM 

The  PSOG  with  30  particles  was  used  to  solve  multiple  double  pass  RTM  problems 
using  the  same  initial  orbits  investigated  in  the  single  pass  RTM.  The  exclusion  zone, 
exclusion  ellipses,  and  apogee/perigee  constraints  also  remained  the  same  as  those 
investigated  in  the  single  pass  RTM  problems.  A  summary  of  the  double  pass  RTM  is 
shown  in  Equation  3.15: 

(3.15) 

The  lowest  cost  solution  obtained  by  the  PSO  over  the  course  of  20  runs  is  here 
referred  to  as  the  optimal  solution  (given  that  there  is  no  analytical  solution).  Table  3.3 
shows  the  lowest  cost  found  by  the  PSO  over  the  course  of  20  runs  as  a  function  of  varying 
exclusion  ellipse  size.  The  associated  design  variables  for  each  case  can  be  seen  in  Table 
3.6  of  the  Appendix.  Figures  3.5(a)  and  3.5(b)  show  the  optimal  maneuver  times  and  arrival 
locations  on  the  exclusion  ellipse. 

The  results  seen  for  the  double  pass  RTM  problems  are  very  similar  to  those  seen  for 
the  single  pass  cases.  The  average  time  required  to  execute  20  runs  was  235.70  s.  The 
PSO  converged  to  one  of  four  solutions  for  each  case  considered.  The  maneuver  times 
and  arrival  locations  on  the  exclusion  ellipses  for  each  pass  are  nearly  the  same  as  those 
seen  in  the  single  pass  cases.  Once  again,  the  difference  between  the  global  and  local 
solutions  increased  with  increasing  exclusion  ellipse  size  with  a  maximum  of  0.059  m/s 
for  ro  =  6800  km  and  0.050  m/s  for  ro  =  7300  km.  Similar  to  the  single  pass  cases,  the 
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Table  3.3:  Optimal  cost  of  double  pass  RTM  problem  for  varying  exclusion  ellipse  sizes 


a^jbe  {km) 


To,  km 

50/5 

60/6 

70/7 

80/8 

90/9 

100/10 

110/11 

120/12 

130/13 

140/14 

150/15 

1.365 

1.638 

1.910 

2.182 

2.454 

2.726 

2.998 

3.269 

3.541 

3.812 

4.083 

6800 

< 

1.366 

1.640 

1.912 

2.185 

2.458 

2.731 

3.003 

3.276 

3.548 

3.821 

4.093 

J 

2.732 

3.278 

3.823 

4.368 

4.912 

5.457 

6.001 

6.545 

7.089 

7.633 

8.176 

1.228 

1.473 

1.718 

1.962 

2.207 

2.451 

2.696 

2.940 

3.184 

3.428 

3.672 

7300 

^V2 

1.229 

1.474 

1.720 

1.965 

2.210 

2.455 

2.701 

2.946 

3.191 

3.435 

3.680 

J 

2.457 

2.947 

3.438 

3.927 

4.417 

4.907 

5.396 

5.886 

6.375 

6.864 

7.352 

2880 

2878 
I  2876 

Hi 

,6 
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(U 

§  2872 
2870 


2868^ 

40 


60  80  100  120  140  160 

Exclusion  Ellipse  a  (km) 


0 

0 
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(a)  T\  and  r2  as  functions  of  exclusion  ellipse  size  (b)  Ox  and  O2  as  functions  of  exclusion  ellipse  size 

Figure  3.5:  Optimal  design  variables  and  constraints  for  double  pass  RTM  as  functions  of 
exclusion  ellipse  size  {vq  =  6800  km) 


lowest  cost  solutions  required  the  spacecraft  to  arrive  over  the  exclusion  zone  with  a  lower 
altitude  and  in  advance  of  its  expected  arrival  time  for  each  pass,  regardless  of  exclusion 
ellipse  size. 

In  each  case,  the  optimal  first  maneuver  nearly  (but  not  exactly)  matches  that  seen 
in  the  single  pass  RTM  for  exclusion  ellipses  of  the  same  size.  Additionally,  the  second 
maneuver  is  very  similar  to  the  first  in  terms  of  the  time  of  flight  needed  to  complete  the 
maneuver  {T\  and  T2)  and  the  intercept  location  (0i  and  62)  on  the  exclusion  ellipse,  but 
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always  requires  more  fuel  to  execute.  Equation  3.14  is  once  again  an  accurate  predictor  of 
maneuver  cost,  with  a  maximum  difference  between  the  predicted  and  actual  cost  of  0.0072 
m/s  for  To  =  6800  km  and  0.0068  m/s  for  tq  =  7300  km. 

3.7.3. 2  Triple  Pass  RTM 

A  PSOG  with  60  particles  was  used  to  optimize  triple  pass  RTM  problems  with  the 
same  conditions  studied  in  the  single  and  double  pass  cases.  The  increase  in  the  number  of 
particles  was  meant  to  account  for  the  higher  dimensionality  of  the  solution  space.  Equation 
3.16  summarizes  the  triple  pass  RTM  problem. 

(3.16) 

The  average  time  required  to  complete  20  runs  was  706.68  s.  This  is  a  significant 
increase  over  the  single  and  double  pass  cases,  and  is  likely  due  to  the  larger  search  space 
as  well  as  an  increased  swarm  size.  The  lowest  cost  solutions  are  shown  in  Table  3.4 
and  the  associated  design  variables  can  be  seen  in  Table  3.7  of  the  Appendix.  The  PSO 
found  several  local  optimal  solutions  in  addition  to  those  shown  in  Table  3.4.  The  largest 
difference  between  the  local  solutions  and  the  best  known  solutions  were  0.089  m/s  for 
ro  =  6800  km  and  0.075  m/s  for  tq  =  7300  km,  and  occurred  when  Ue  =  150  km.  Eigures 
3.6(b)  and  3.6(a)  show  the  optimal  arrival  locations  and  maneuver  times  for  the  triple  pass 
RTM.  Equation  3.14  is  accurate  to  within  0.0073  m/s  for  tq  =  6800  km  and  0.0068  m/sec 
for  ro  =  7300  km. 
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Table  3.4:  Optimal  cost  of  triple  pass  RTM  problem  for  varying  exclusion  ellipse  sizes 


aejbe  km 


ro,  km 

50/5 

60/6 

70/7 

80/8 

90/9 

100/10 

110/11 

120/12 

130/13 

140/14 

150/15 

1.365 

1.638 

1.910 

2.182 

2.454 

2.726 

2.998 

3.269 

3.541 

3.812 

4.083 

6800 

< 

1.366 

1.640 

1.912 

2.185 

2.458 

2.731 

3.003 

3.276 

3.548 

3.821 

4.093 

AV3 

1.366 

1.639 

1.911 

2.184 

2.456 

2.728 

3.000 

3.272 

3.544 

3.816 

4.088 

J 

4.098 

4.916 

5.734 

6.551 

7.369 

8.185 

9.002 

9.818 

10.633 

11.448 

12.263 

1.228 

1.473 

1.718 

1.962 

2.207 

2.451 

2.696 

2.940 

3.184 

3.428 

3.672 

7300 

< 

1.229 

1.474 

1.719 

1.965 

2.210 

2.455 

2.700 

2.946 

3.191 

3.435 

3.680 

AV3 

1.228 

1.473 

1.719 

1.964 

2.209 

2.453 

2.698 

2.943 

3.187 

3.432 

3.676 

J 

3.684 

4.420 

5.156 

5.891 
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8.094 

8.828 
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Figure  3.6:  Optimal  design  variables  and  constraints  for  triple  pass  RTM  as  functions  of 
exclusion  ellipse  size  (ro  =  6800  km) 


3.8  Conclusion 

The  particle  swarm  optimization  algorithm  proved  to  be  an  effective  tool  for  solving 
single  and  multiple  pass  responsive  theater  maneuvers  for  a  variety  of  exclusion  ellipse 
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sizes.  The  global  and  local  solutions  to  the  responsive  theater  maneuver  problem, 
regardless  of  the  number  of  passes  considered,  are  very  similar  in  terms  of  time  of  flight 
and  the  optimal  intercept  location  on  the  exclusion  ellipse.  The  small  costs  associated 
with  these  maneuvers  make  the  responsive  theater  maneuver  construct  a  viable  alternative 
to  increase  satellite  resiliency  in  a  tactical  scenario.  Further,  the  methodology  presented  in 
this  research  could  be  applied  to  longer  mission  scenarios  or  extended  to  include  maneuvers 
that  take  multiple  orbits  to  intercept  the  exclusion  ellipse,  such  as  a  case  where  a  spacecraft 
has  several  orbits  before  it  would  overfly  the  exclusion  zone. 

3.9  Appendix 

Tables  3.5,  3.6,  and  3.7  show  the  optimal  maneuvering  solutions  for  the  single,  double, 
and  triple  pass  RTM  cases,  respectively. 
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Table  3.5:  Optimal  single  pass  RTM  for  various  exclusion  ellipse  sizes 


Uelbe,  km 

Ti.s 

01 ,  rad 

J,  m/s 

Time,  s 

No.  Optimal/Total,  % 

''0 

=  6800  km 

50/5 

2870.85 

5.90534 

1.365 

157.99 

45 

60/6 

2871.67 

5.90546 

1.638 

159.80 

55 

lOP 

2872.46 

5.90557 

1.910 

199.54 

50 

80/8 

2873.25 

5.90568 

2.182 

219.94 

30 

90/9 

2874.07 

5.90580 

2.454 

207.20 

60 

100/10 

2874.86 

5.90591 

2.726 

199.53 

65 

110/11 

2875.65 

5.90602 

2.998 

191.98 

50 

120/12 

2876.48 

5.90611 

3.269 

176.90 

65 

130/13 

2877.27 

5.90625 

3.541 

187.18 

65 

140/14 

2878.07 

5.90636 

3.812 

120.49 

40 

150/15 

2878.86 

5.90647 

4.083 

204.93 

55 

''0 

=  7300  km 

50/5 

3192.97 

5.90531 

1.228 

148.71 

40 

60/6 

3193.78 

5.90541 

1.473 

135.38 

55 

lOP 

3194.62 

5.90552 

1.718 

201.11 

45 

80/8 

3195.43 

5.90562 

1.962 

241.04 

35 

90/9 

3196.27 

5.90573 

2.207 

196.60 

60 

100/10 

3197.08 

5.90583 

2.451 

221.50 

55 

110/11 

3197.93 

5.90594 

2.696 

198.20 

50 

120/12 

3198.74 

5.90604 

2.940 

288.01 

60 

130/13 

3199.59 

5.90615 

3.184 

277.72 

35 

140/14 

3200.40 

5.90625 

3.428 

214.36 

50 

150/15 

3201.25 

5.90636 

3.672 

283.35 

50 
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Table  3.6:  Optimal  double  pass  RTM  for  various  exclusion  ellipse  sizes 


aejbe,  km 

ri,s 

6\,  rad 

7’2,S 

02,  rad 

Ay, 

Av2 

J,  m/s 

Time,  sec 

No.  Optimal/Total,  % 

ro  = 

6800  km 

50/5 

2870.99 

5.90538 

2869.23 

5.90545 

1.365 

1.366 

2.732 

288.30 

5 

60/6 

2871.81 

5.90550 

2869.69 

5.90558 

1.638 

1.640 

3.277 

226.58 

25 

lOP 

2872.63 

5.90562 

2870.18 

5.90572 

1.910 

1.912 

3.823 

206.24 

25 

80/8 

2873.49 

5.90575 

2870.64 

5.90585 

2.182 

2.185 

4.368 

207.01 

10 

90/9 

2874.32 

5.90587 

2871.14 

5.90599 

2.454 

2.458 

4.912 

205.81 

10 

100/10 

2875.14 

5.90599 

2871.63 

5.90613 

2.726 

2.731 

5.457 

206.96 

25 

110/11 

2875.97 

5.90611 

2872.10 

5.90626 

2.998 

3.003 

6.001 

220.59 

10 

120/12 

2876.79 

5.90623 

2872.56 

5.90639 

3.269 

3.276 

6.545 

204.65 

30 

130/13 

2877.61 

5.90635 

2873.06 

5.90653 

3.541 

3.548 

7.089 

223.82 

30 

140/14 

2878.45 

5.90647 

2873.53 

5.90666 

3.812 

3.821 

7.632 

223.11 

30 

150/15 

2879.28 

5.90659 

2874.00 

5.90679 

4.083 

4.093 

8.176 

236.09 

20 

'■o  = 

7300  km 

50/5 

3193.20 

5.90537 

3191.15 

5.90538 

1.228 

1.229 

2.456 

228.61 

20 

60/6 

3194.05 

5.90548 

3191.61 

5.90550 

1.473 

1.474 

2.947 

234.71 

35 

lOP 

3194.93 

5.90560 

3192.08 

5.90562 

1.718 

1.720 

3.437 

229.87 

25 

80/8 

3195.82 

5.90572 

3192.55 

5.90574 

1.962 

1.965 

3.927 

236.91 

25 

90/9 

3196.70 

5.90584 

3193.01 

5.90586 

2.207 

2.210 

4.417 

223.01 

30 

100/10 

3197.55 

5.90595 

3193.48 

5.90598 

2.451 

2.455 

4.907 

339.88 

15 

110/11 

3198.44 

5.90607 

3193.96 

5.90610 

2.696 

2.700 

5.396 

240.80 

25 

120/12 

3199.33 

5.90619 

3194.43 

5.90622 

2.940 

2.946 

5.885 

249.52 

15 

130/13 

3200.18 

5.90630 

3194.90 

5.90634 

3.184 

3.191 

6.375 

261.34 

15 

140/14 

3201.07 

5.90642 

3195.38 

5.90646 

3.428 

3.435 

6.863 

240.76 

15 

150/15 

3201.96 

5.90654 

3195.85 

5.90658 

3.672 

3.680 

7.352 

250.89 

20 

60 


Table  3.7:  Optimal  triple  pass  RTM  for  various  exclusion  ellipse  sizes 


aejbe,  km 

Ji.s 

01 ,  rad 

7’2,s 

02,  rad 

7’3,S 

03,  rad 

J,  m/s 

Time,  s 

No.  Optimal/Total,  % 

ro 

=  6800  km 

50/5 

2870.65 

5.90530 

2868.96 

5.90539 

2867.62 

5.90505 

4.098 

536.47 

5 

60/6 

2871.81 

5.90550 

2869.83 

5.90562 

2867.69 

5.90509 

4.916 

460.36 

10 

IQjl 

2872.63 

5.90562 

2870.32 

5.90576 

2867.81 

5.90514 

5.734 

410.37 

15 

80/8 

2873.57 

5.90577 

2870.76 

5.90588 

2868.12 

5.90524 

6.551 

694.94 

1.75 

90/9 

2874.28 

5.90586 

2871.34 

5.90605 

2868.11 

5.90525 

7.369 

698.45 

10 

100/10 

2875.07 

5.90597 

2871.81 

5.90618 

2868.24 

5.90530 

8.185 

908.53 

10 

110/11 

2875.93 

5.90610 

2872.31 

5.90632 

2868.37 

5.90535 

9.002 

622.69 

10 

120/12 

2876.76 

5.90622 

2872.84 

5.90647 

2868.51 

5.90540 

9.818 

639.11 

2.63 

130/13 

2877.60 

5.90634 

2873.39 

5.90662 

2868.65 

5.90545 

10.633 

541.34 

15 

140/14 

2878.38 

5.90645 

2873.85 

5.90675 

2868.77 

5.90550 

11.448 

686.64 

10 

150/15 

2879.24 

5.90658 

2874.31 

5.90688 

2868.95 

5.90556 

12.263 

689.92 

15 

ro 

=  7300  km 

50/5 

3193.16 

5.90536 

3191.34 

5.90543 

3189.43 

5.90501 

3.684 

1276.04 

10 

60/6 

3194.05 

5.90548 

3191.89 

5.90557 

3189.52 

5.90505 

4.420 

728.71 

10 

IQjl 

3194.93 

5.90560 

3192.35 

5.90569 

3189.66 

5.90510 

5.156 

513.70 

15 

80/8 

3195.78 

5.90571 

3192.90 

5.90583 

3189.76 

5.90514 

5.891 

763.20 

15 

90/9 

3196.66 

5.90583 

3193.37 

5.90595 

3189.86 

5.90518 

6.626 

884.74 

10 

100/10 

3197.51 

5.90594 

3193.91 

5.90609 

3190.00 

5.90523 

7.360 

794.95 

5 

110/11 

3198.40 

5.90606 

3194.42 

5.90622 

3190.10 

5.90527 

8.094 

870.69 

3.45 

120/12 

3199.28 

5.90618 

3194.90 

5.90634 

3190.24 

5.90532 

8.828 

820.93 

4.35 

130/13 

3200.17 

5.90630 

3195.45 

5.90648 

3190.38 

5.90537 

9.562 

482.37 

15 

140/14 

3201.02 

5.90641 

3195.97 

5.90661 

3190.48 

5.90541 

10.295 

724.63 

5 

150/15 

3201.91 

5.90653 

3196.48 

5.90674 

3190.59 

5.90545 

11.028 

789.73 

10 
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IV.  Low  Thrust  Responsive  Theater  Maneuvers  Using  Particle  Swarm 
Optimization  and  Direct  Collocation 


(.Pbest} 

4.1  Abstract 

This  research  investigates  a  low-thrust  implementation  of  the  responsive  theater 
maneuver,  which  is  designed  to  alter  a  spacecraft’s  entry  conditions  as  it  overflies  a 
specified  geographic  region,  called  the  exclusion  zone.  A  particle  swarm  optimization 
algorithm  employing  shape-based  low-thrust  trajectory  approximation  is  used  to  seed 
a  direct  orthogonal  collocation  routine  employing  a  nonlinear  programming  problem 
solver.  This  approach  is  used  to  generate  optimal  low-thrust  responsive  theater  maneuver 
trajectories.  The  combination  of  particle  swarm  optimization,  shape-based  low-thrust 
trajectory  approximation,  and  direct  orthogonal  collocation  is  shown  to  generate  fuel- 
optimal  trajectories  for  single,  double,  and  triple  pass  cases  of  the  responsive  theater 
maneuver  problem.  Further,  these  low-thrust  trajectories  are  shown  to  satisfy  the  analytical 
necessary  conditions  for  an  optimal  control  and  require  delta-velocities  only  slightly 
larger  than  those  required  for  impulsive  responsive  theater  maneuvers  delivering  the 
same  effects.  As  low-thrust  propulsion  technology  improves,  the  low-thrust  responsive 
theater  maneuvers  can  provide  propellant  mass  expenditure  savings  over  their  impulsive 
counterparts  despite  requiring  more  delta- velocity. 
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4.2  Nomenclature 


Qe 

At 


A 


A 


be 


hk 


Nr. 


P 

Ra. 

Re 


rk 

n 

Rfn 

Rn. 


R 


Pk 


ra 


to 


tk 


Vo 


Vk 


semimajor  axis  of  exclusion  ellipse,  km 
low-thrust  maneuver  thrust  acceleration,  mj  sec^ 
maximum  allowable  low-thrust  maneuver  thrust  acceleration,  ml  sec^ 
minimum  allowable  low-thrust  maneuver  thrust  acceleration,  m/sec^ 
semiminor  axis  of  exclusion  ellipse,  km 

expected  angular  momentum  vector  of  satellite  at  time  of  entry  into 
exclusion  zone,  krn^/ sec 

minimum  number  of  orbital  revolutions  required  for  multiple  revolution 

impulsive  maneuver 

period  of  the  initial  orbit,  sec 

orbit  apogee  radius  after  the  k!’^  maneuver,  km 

distance  from  expected  position  of  the  spacecraft  to  the  actual  position  of 
the  spacecraft,  km 

expected  position  vector  of  satellite  at  time  of  entry  into  exclusion  zone,  km 

actual  position  vector  of  spacecraft  at  k!’^  time  of  entry  into  exclusion  zone,  km 

position  vector  of  spacecraft  at  the  instant  just  before  the  k'^  impulse,  km 

maximum  allowable  orbital  radius,  km 

minimum  allowable  orbital  radius,  km 

orbit  perigee  radius  after  the  maneuver,  km 

initial  position  vector,  km 

initial  time,  sec 

expected  time  of  entry  into  exclusion  zone,  sec 
initial  velocity  vector,  km  j  sec 

expected  velocity  vector  of  spacecraft  at  time  of  entry  into 
exclusion  zone,  km/ sec 
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=  actual  velocity  vector  of  spacecraft  at  time  of  entry  into 
exclusion  zone,  km/ sec 

Vk;  =  velocity  vector  of  spacecraft  at  the  instant  just  before  the  k^^  impulse,  km/ sec 

Vk+  =  velocity  vector  of  spacecraft  at  the  instant  just  after  the  k^^  impulse,  km  j sec 

Tk  =  time  of  flight  of  the  k^^  maneuver,  sec 

jk  =  expected  flight  path  angle  at  exclusion  zone  entry  for  the  k^^ 

y\  =  post-maneuver  flight  path  angle  for  the  k^^  maneuver,  rad 

jk,  =  pre-maneuver  flight  path  angle  for  the  k^^  maneuver,  rad 

rj  =  thrust  pointing  angle,  rad 

6k  =  angle  defining  position  of  spacecraft  on  the  k‘’^  exclusion  ellipse,  rad 

A  =  geocentric  longitude,  deg 

jjL  =  Earth’s  gravitational  parameter, 

0  =  geocentric  latitude,  deg 

if/k  =  expected  angle  traveled  by  the  spacecraft  in  the  orbit  plane  during  the 
k‘^  maneuver,  rad 

if/l  =  actual  angle  traveled  by  the  spacecraft  in  the  orbit  plane  during  the 
k‘^  maneuver,  rad 

4.3  Introduction 

The  topic  of  system  resiliency  has  become  increasingly  relevant  in  the  space 
community.  The  2010  United  States  National  Space  Policy  [1],  2011  National  Security 
Space  Strategy  [2],  and  the  2014  Quadrennial  Defense  Review  [3]  all  highlight  the 
importance  of  resiliency.  Specifically,  [1]  states  that  one  of  the  primary  goals  of  U.S. 
space  policy  is  to  increase  spacecraft  resiliency  against  “denial,  disruption,  or  degradation” 
from  environmental  and  hostile  causes.  [4]  highlighted  four  basic  principles  which  define 
resilience:  avoidance,  robustness,  reconstitution,  and  recovery.  In  particular,  avoidance  is 
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defined  as  “countermeasures  against  potential  adversaries,  proactive  and  reactive  defensive 
measures  taken  to  diminish  the  likelihood  and  consequence  of  hostile  acts  or  adverse 
conditions.” 

Recently,  [94]  embraced  the  concept  of  resiliency  through  avoidance  and  introduced 
impulsive  responsive  theater  maneuvers  (RTMs).  These  maneuvers  enhance  resiliency  by 
introducing  uncertainty  into  a  spacecraft’s  arrival  conditions  upon  entry  into  a  specified 
geographic  region,  called  the  exclusion  zone.  The  RTM  requires  the  spacecraft  to  lie  on 
an  exclusion  ellipse  at  the  expected  entry  time  into  the  exclusion  zone.  The  ellipse  is 
centered  at  the  expected  arrival  position  of  the  spacecraft  into  the  exclusion  zone.  This 
research  introduces  a  low-thrust  version  of  the  RTM,  which  takes  advantage  of  the  shape- 
based  low-thrust  trajectory  approximation  technique  introduced  in  [42] .  A  particle  swarm 
optimization  (PSO)  algorithm  which  employs  the  shape-based  technique  is  used  to  generate 
feasible  low-thrust  RTM  trajectories.  These  trajectories  are  then  used  as  initial  guesses  to 
seed  a  direct  orthogonal  collocation  method  employing  a  nonlinear  programming  (NLP) 
problem  solver.  This  approach  is  shown  to  generate  optimal  trajectories  for  single,  double, 
and  triple  pass  RTMs. 

4.4  Background 

Conway  [51]  provided  a  comprehensive  survey  on  state-of-the-art  techniques  used  to 
optimize  spacecraft  trajectory  problems.  In  this  work,  he  notes  that  methods  employing 
NLP  problem  solvers  are  reliant  on  reasonable  initial  guesses  from  which  to  start. 
Dependence  on  initial  guesses  introduces  two  limitations  of  employing  these  methods 
alone.  The  first  is  that  it  is  often  extremely  difficult  to  generate  feasible  initial  guesses 
to  these  highly  nonlinear  problems.  The  second  limitation  is  that  even  when  a  suitable 
initial  guess  is  provided,  NLP  solvers  typically  converge  in  the  neighborhood  of  the  guess, 
making  them  likely  to  converge  to  local  minima. 
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Population-based  optimization  routines  such  as  evolutionary  algorithms  (EAs)  do  not 
suffer  from  these  limitations.  They  do  not  require  an  initial  guess,  but  rather  randomly 
distribute  their  population  uniformly  in  the  solution  space  and  the  associated  costs  are 
evaluated.  The  population  evolves  or  moves  according  to  rules  specific  to  the  particular 
EA  variant  and  the  process  is  repeated.  Additionally,  EAs  are  designed  as  global  search 
algorithms  and  are  more  likely  to  find  a  global  optimal  than  direct  methods  employing 
NEP  solvers  [7].  In  fact,  [7]  notes  that  EAs  are  capable  of  generating  optimal  solutions 
independently  or  can  be  used  to  generate  initial  guesses  for  more  accurate  methods  if 
greater  accuracy  is  required 

There  are  several  examples  in  the  literature  in  which  EAs  have  been  employed 
independently  to  generate  optimal  solutions  to  a  variety  of  spacecraft  trajectory  problems. 
Problems  considered  include  interplanetary  trajectories  [8-19,  21,  22,  24,  25,  85], 
rendezvous  and  docking  [27],  or  low  Earth  orbit  trajectories  to  achieve  some  specific 
ground  effects  such  as  revisit  time  or  coverage  [32-34]. 

Other  research  has  focused  on  the  use  of  EAs  to  generate  suitable  initial  guesses  to 
seed  more  accurate  optimization  techniques  [20,  23,  26,  87,  88,  95,  96].  In  particular, 
[29,  95]  used  genetic  algorithms  employing  the  shape-based  methods  developed  in  [42,  43] 
to  generate  feasible  low-thrust  trajectories,  which  were  used  as  initial  guesses  for  more 
accurate  methods  employing  NEP  solvers.  Specifically,  [95]  employed  the  technique  to 
optimize  an  asteroid  deflection  mission.  [29]  optimized  a  low-thrust  asteroid  rendezvous 
trajectory  in  which  three  of  eight  asteroids  must  be  visited  as  well  as  a  problem  in  which  a 
spacecraft  must  rendezvous  with  one  asteroid  from  each  of  four  groups. 

Similarly,  this  research  uses  PSO  algorithms  employing  the  shape-based  techniques 
from  [42,  43]  to  generate  initial  guesses  for  low-thrust  RTMs.  The  global  version  of  the 
PSO,  originally  developed  in  [52,  53],  consists  of  a  collection  of  particles  initialized  by 
randomly  assigning  each  particle  a  position  and  velocity  vector  in  the  solution  space.  The 
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costs  associated  with  the  positions  of  each  particle  are  used  to  update  the  best  position 
visited  by  swarm,  gbest,  and  the  best  position  ever  visited  by  that  specific  particle,  pbest- 
These  values  are  then  used  to  update  each  particle’s  velocity  vector,  which  in  turn  are  used 
to  update  each  particle’s  position  vector  for  the  next  iteration.  The  process  is  repeated  until 
a  defined  convergence  criteria  is  met  or  a  maximum  number  of  iterations  is  reached. 

[52]  proposed  a  local  variant  of  the  PSO  in  which  gbest  is  replaced  by  Ibest,  the  best 
position  ever  visited  by  a  particle’s  pre-defined  nearest  neighbors.  This  modification  was 
designed  to  prevent  the  algorithm  from  converging  to  local  extrema.  The  local  variant 
has  been  shown  to  be  more  successful  in  converging  to  global  minima  at  the  expense  of 
computational  speed  [52].  The  performance  of  the  local  PSO  is  highly  dependent  on  the 
neighborhood  size  [52].  Hu  et  al.  [97]  noted  that  larger  neighborhood  sizes  provide  faster 
computational  speed  while  smaller  neighborhoods  prevent  premature  convergence.  [54] 
stated  empirical  evidence  showed  that  neighborhood  sizes  equal  to  15%  of  the  swarm  size 
provided  good  performance. 

4.5  Methodology 

4.5.1  Responsive  Theater  Maneuvers 

The  RTM  was  originally  defined  in  [94]  and  is  summarized  below.  The  RTM  is 
designed  to  alter  the  arrival  conditions  of  a  spacecraft  as  it  overflies  the  exclusion  zone, 
a  potentially  hazardous  geographic  region  on  the  earth.  The  exclusion  zone  is  defined  by 
latitude  ((pmin,  (pmax)  and  longitude  (Amin,  Amax)  bands. 

The  satellite  state  at  the  initial  time  to  is  defined  by  Earth-centered,  inertial  position 
and  velocity  vectors,  tq  and  Vq.  The  state  of  the  satellite  is  subject  only  to  two-body  forces 
propagated  forward  using  Kepler’s  equation.  The  earth  is  assumed  spherical,  which  implies 
that  the  spacecraft’s  geocentric  longitude  A  and  latitude  (p  can  be  computed  at  any  time  using 
the  current  position  vector  and  the  Greenwich  Mean  Time  (GMT).  For  simplicity,  GMT  at 
to  is  assumed  zero. 
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[94]  defines  an  analytical  method  to  determine  the  expected  time  of  entry  ti  into  the 
exclusion  zone  as  well  as  the  expected  position  and  velocity  vectors,  ri  and  Vi,  respectively. 
These  quantities  define  the  specific  angular  momentum  vector  and  the  vector,  which 
define  the  orientation  of  the  exclusion  ellipse  centered  at  ri .  The  definition  of  is  shown 
in  Equation  4.1 


= 


Vi  X  h\ 

|vi||/ii| 


(4.1) 


The  RTM  requires  the  spacecraft  to  maneuver  such  that  its  actual  arrival  position  is  on 
the  exclusion  ellipse  at  ti.  The  ellipse  is  oriented  such  that  the  semimajor  axis  Ue  is  aligned 
with  V\  and  semiminor  axis  be  is  aligned  with  ^i,  resulting  in  an  in-plane  maneuver. 

The  spacecraft’s  actual  position  at  t\  is  defined  by  Equation  (4.2),  where  6\  is  an 
angular  variable  measured  from  V\  in  the  direction  of  ^i. 


V\ 

r\=ri+  Re  cos  e^  —  +  Re  sin 
|vil 


where 


R.  = 


Qebe 


(4.2) 


(4.3) 


■^bl  cos^  6i  +  al  sin^  6\ 

The  variable  T i  defines  the  time  in  advance  of  t\  at  which  the  maneuver  is  initiated  in 
addition  to  the  position  r\-  and  velocity  Vi-  vectors  just  prior  to  maneuver  initiation.  That 
is,  maneuver  initiation  occurs  at  ti  -  Ti  s.  In  the  low-thrust  version  of  the  RTM,  the  variable 
T 1  also  defines  the  duration  of  the  maneuver. 

The  post-maneuver  orbit  is  constrained  such  that  its  apogee  Ra^  must  be  less  than 
a  maximum  allowable  apogee  Ra^^x  perigee  Rp^  must  be  greater  than  a  minimum 

allowable  perigee  These  constraints  are  specified  to  ensure  the  spacecraft  meets 

sensor  range  constraints  required  by  the  mission. 
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4.5.2  Shape-Based  Approximation  Method  Applied  to  Responsive  Theater  Maneu¬ 
vers 

Wall  and  Conway  [42]  developed  a  two-dimensional  shape-based  method  to  approx¬ 
imate  low-thrust  interception  trajectories.  This  method  can  be  applied  to  RTMs  because 
the  maneuvers  are  restricted  to  the  plane  of  the  initial  orbit.  The  specific  details  for  the 
shape-based  approximation  are  outside  the  scope  of  this  paper,  but  can  be  found  in  [42]. 
Some  details,  such  as  system  dynamics,  are  presented  here  for  convenience.  The  notation 
is  slightly  modified  from  the  original  work  to  avoid  confusion  with  notation  used  for  the 
RTM. 

The  shape-based  method  defined  four  states  in  polar  coordinates:  the  radius  magnitude 
r,  angle  ifj,  radial  velocity  Vr,  and  tangential  velocity  which  are  subject  to  the  dynamics 
shown  in  Equation  4.4.  The  controls  are  the  thrust  acceleration  Aj  and  the  control  angle  t]. 

r  =  Vr 

(4.4) 

K  =  -y  -  ^  +  At  smr] 

%  =  -^+ArCOS77 

The  shape-based  approximation  generates  a  trajectory  and  the  corresponding  AT  given 
the  pre-maneuver  position  and  velocity  magnitudes  r^-  and  Vy,  the  pre-maneuver  flight  path 
angle  71,,  the  final  position  magnitude  r\,  the  final  velocity  magnitude  v],  the  final  flight 
path  angle  7],  the  total  angle  traveled  i/f],  and  the  maneuver  time  T^.  It  is  not  necessary  to 
convert  from  the  Cartesian  coordinates  used  to  define  the  RTM  to  the  polar  coordinates;  all 
inputs  required  for  the  shape-based  approximation  can  be  defined  using  the  RTM  variables 
or  specified  as  optimization  parameters.  Specifically,  the  RTM  variables  6\  and  T 1  define 
all  of  these  quantities  except  for  and  7],  which  become  optimization  parameters. 

Recall  61  defines  the  desired  entry  position  of  the  spacecraft  onto  the  exclusion  ellipse 
at  t\  and  thus  the  final  position  magnitude  r\.  The  maneuver  time  Ti  is  used  along  with 
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Kepler’s  equation  to  define  the  position  and  velocity  vectors  at  maneuver  initiation,  ri- 
and  V\-,  respectively.  As  a  result,  ri-  and  vi-  are  simply  the  magnitudes  of  ri-  and  V\-, 
respectively.  The  pre-maneuver  state  also  defines  yi,. 


Additionally,  Ti  defines  the  expected  angle  the  spacecraft  will  travel  from 
maneuver  initiation  to  exclusion  zone  entry.  Consequently,  ifj\  can  be  calculated  according 
to  Equation  4.5,  where  is  the  magnitude  of  ri. 


il/\  =  ipi  +  6  cos 


-1 


'{Ref  -  {nf  -  (i 

-2rirj 

V 

/ 

(4.5) 


Equation  4.5  includes  the  variable  6,  which  takes  on  a  value  of  either  positive  or 
negative  one  and  is  determined  using  6^  and  the  orientation  of  the  exclusion  ellipse  with 
respect  to  r^.  This  orientation  is  defined  by  the  expected  flight  path  angle  yi  of  the 
spacecraft  upon  entry  into  the  exclusion  zone.  Eigure  4.1  shows  this  orientation  and 
Equation  4.6  defines  the  value  of  d  as  a  function  of  y\. 


-1  if  f-yi<0i<y-ri 


(4.6) 


1  otherwise 

As  a  result,  the  variables  6i  and  T i  define  all  required  variables  for  the  shape-based 
approximation  except  Vj  and  y\.  These  parameters  become  optimization  variables  and 
define  the  actual  velocity  vector  of  the  spacecraft  as  it  arrives  on  the  exclusion  ellipse. 
The  final  flight  path  angle  is  restricted  such  that  y  <  yj  <  |  to  ensure  the  final  trajectory 
is  prograde.  It  should  be  noted  that  all  distances  and  times  are  scaled  prior  to  input  into  the 
shape-based  approximation.  The  scaling  is  such  that  distances  are  scaled  by  the  semimajor 
axis  of  the  initial  orbit  in  km  and  all  times  are  scaled  such  that  In  time  units  are  equal  to 
the  original  orbit’s  period  in  s. 

A  single  pass  low-thrust  RTM  can  be  extended  to  accommodate  subsequent  passes  by 
reinitializing  the  parameters  after  each  maneuver.  That  is,  6,  Tj,  and  Vj  become  the  initial 
conditions  to  determine  the  second  exclusion  zone  entry. 
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Figure  4.1:  Exclusion  ellipse  orientation  with  respect  to  71 


4.5.3  Optimal  Low-Thrust  Responsive  Theater  Maneuvers 
It  is  important  to  note  that  the  shape-based  approach  defined  in  [42]  generates  feasible, 
albeit  suboptimal,  trajectories.  The  approach  taken  in  this  research  was  to  implement  a 
PSO  algorithm  combined  with  the  shape-based  approach  to  generate  low-thrust  trajectories 
to  provide  initial  guesses  into  an  optimization  package  [98]  employing  direct  orthogonal 
collocation  (DOC)  [48-50,  99]  to  convert  the  problem  into  an  NLP  problem.  The  Interior 
Point  Optimizer  (IPOPT)  [100]  was  employed  as  the  NLP  solver. 

The  PSO  employed  in  this  research  is  used  to  identify  the  minimum  AT  solution 
resulting  from  the  shape-based  method.  The  death  penalty  method  was  used  to  assign 
infinite  cost  to  those  trajectories  not  satisfying  the  apogee  and  perigee  constraints.  No 
restriction  was  placed  on  the  maximum  allowable  thrust  acceleration  for  trajectories 
generated  by  the  PSO,  but  rather  thrust  acceleration  restrictions  were  applied  during  the 
DOC  portion  of  the  optimization.  The  optimal  control  problem  for  the  low-thrust  RTM  is 
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subject  to  the  dynamics  in  Equation  4.4  and  has  the  form  shown  in  Equation  4.7. 


minimize  J  =  AT]  =  j 

('At  dt 

subject  to: 

Exclusion  zone: 

^max)^  ^max) 

Ra^  <Ra 

^Pmin  —  1 

At  .  ^  At  ^  At 

^  mm  —  -*  —  ^  max 

0  <  7]  <2n 

Thus,  the  system  Hamiltonian  can  be  written  as  shown  in  Equation  4.8.  The  variables 
Ar,  A^,  Av^,  and  Ay^  are  the  Eagrange  multipliers  corresponding  to  r,  i/r,  Vr  and  V^, 


respectively. 


=  A,V,  +  Af—  +  A 


r  r 
V  J 


+  Avj.  I  - 


V^Vr 


+  Ar  sin?7  +  cos  77)  (4.8) 


According  to  Pontryagin’s  Minimum  Principle,  the  optimal  control  can  be  found  by 
minimizing  the  Hamiltonian  at  all  times  from  to  to  t\.  Thus,  the  optimal  pointing  angle  is 
shown  in  Equation  4.9,  where  Ay  =  yJiAy^f'  +  [Ay^)  . 


■  Av 


(4.9) 


Ay 


sm?7  = 
cos  7]  = 

Similarly,  the  optimal  thrust  magnitude  is  shown  in  Equation  4.10,  where  s  = 
+  Ty^  sin  rj  +  Ay^  cos  77 j  is  the  switching  function. 

At  if  s  <  0 

(4.10) 

otherwise 

Equations  4.9  and  4. 10  were  employed  to  verify  that  trajectories  converged  upon  by 
the  DOC  satisfied  the  analytical  necessary  conditions  for  an  optimal  control. 


4.6  Analysis 

4.6.1  Single  Pass  Responsive  Theater  Maneuvers 

The  impulsive  single  pass  RTM  scenarios  investigated  in  [94]  were  analyzed  using  the 
low-thrust  method  described  above.  These  scenarios  included  multiple  exclusion  ellipse 
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sizes  where  ranged  from  50  km  to  150  km  in  increments  of  10  A:m  and  bg  =  QAag. 
Additionally,  two  different  orbits  were  evaluated.  The  first  orbit  was  a  circular,  45°  inclined 
orbit  with  semimajor  axis  equal  to  6800  km.  The  initial  conditions  were  such  that  the 
spacecraft  starts  at  the  ascending  node  of  the  orbit.  The  second  orbit  was  identical  to  the 
first  except  the  semimajor  axis  was  increased  to  7300  km.  The  maximum  allowable  thrust 
acceleration  was  set  equal  to  two  meters  per  second  squared  while  the  minimum 
thrust  acceleration  was  zero  meters  per  second  squared.  The  thrust  angle  rj  was 
unconstrained. 

A  PSO  algorithm  was  used  to  generate  the  fuel-optimal  shape-based  trajectories  with 
respect  to  three  of  the  four  variables  required  for  the  low-thrust  RTM:  6i,  Vj,  and  y\.  The 
variable  Ti  was  fixed  for  the  purposes  of  this  research.  Fixing  T\  is  justified  because  the 
goal  of  running  the  PSO  was  to  generate  feasible  trajectories  to  use  as  initial  guesses  into 
the  DOC. 

In  the  single  pass  case  Ti  =  t\-tQ.  The  bounds  for  each  variable  are  shown  in  Equation 
4. 1 1,  while  the  PSO  settings  are  shown  in  Table  5.2.  The  cost  function  tolerance  was  le  -  3 


m/s. 


(4.11) 


Table  4.1:  PSO  settings 


Swarm  Size 

40 

Max  Iterations 

1000 

Cognitive  Parameter 

2.09 

Social  Parameter 

2.09 

Constriction  Factor 

0.656295 
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Research  on  impulsive  RTMs  indicated  locally  optimal  solutions  corresponding  to 
increases  and  decreases  in  altitude  [94].  As  a  result,  the  initial  guesses  used  as  inputs 
into  the  DOC  were  chosen  such  that  one  resulted  from  the  lowest  cost  PSO  solution 
corresponding  to  an  increase  in  altitude  and  the  other  corresponded  to  the  lowest  cost  PSO 
solution  corresponding  to  a  decrease  in  altitude.  The  PSO  was  used  to  solve  each  case 
twenty  times  and  the  lowest  cost  solutions  corresponding  to  an  increase  and  decrease  in 
altitude  were  chosen  as  initial  guesses  for  consecutive  calls  to  the  DOC.  The  first  call 
discretized  the  continuous  time  problem  into  one  phase  consisting  of  80  collocation  points. 
The  minimum  allowable  thrust  Ax  was  set  such  that  Ax  .  =  O.lAx  .  The  output  from 
this  call  was  used  as  the  input  to  a  second  call  to  the  DOC,  which  discretized  the  problem 
into  a  single  phase  consisting  160  collocation  points.  Additionally,  Aj-^.^  was  set  equal  to 
zero.  This  optimization  scheme  provided  consistent  convergence  for  all  cases  considered 
in  this  research. 

The  lowest  cost  solution  found  for  each  case  was  considered  to  be  the  minimum.  The 
combination  of  PSO  and  DOC  converged  to  solutions  meeting  all  constraints  and  satisfying 
the  analytical  necessary  conditions  shown  in  Equations  4.9  and  4.10  for  each  case.  Figure 
4.2  depicts  the  change  in  exclusion  zone  entry  conditions  while  Figure  4.3  shows  that  the 
trajectory  satisfies  the  optimal  control  conditions  for  the  case  with  vq  =  6800  km  and 
Ue  =  150  km.  The  results  are  representative  of  those  seen  for  all  other  cases. 

Figures  4.2(a)  and  4.2(b)  show  the  entry  conditions  into  the  exclusion  zone  and  the 
arrival  conditions  on  the  exclusion  ellipse  in  the  perifocal  frame,  respectively.  Figure  4.3(a) 
shows  the  thrust  magnitude  history  and  the  value  of  the  switching  function.  Figure  4.3(b) 
shows  the  necessary  condition  for  the  thrust  pointing  angle  while  the  thruster  is  on.  These 
figures  demonstrate  that  the  trajectory  satisfies  the  analytical  necessary  conditions  for  an 
optimal  control  defined  in  Equations  4.9  and  4.10. 
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(a)  Actual  latitude  and  longitude  and  expected  zone  (b)  Arrival  location  on  exclusion  ellipse 
entry 

Figure  4.2:  Exclusion  zone  and  exclusion  ellipse  arrival  conditions  for  ro  =  6800  km, 
Ue  =  150  km 
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(a)  At  magnitude  and  switching  function 


(b)  Optimal  thrust  pointing  condition 


Figure  4.3:  Optimal  control  necessary  conditions  for  ro  =  6800  km,  =  150  km 


Table  4.2  shows  the  optimal  cost  for  each  single  pass  low-thrust  RTM  investigated.  In 
all  cases,  the  spacecraft  performs  a  maneuver  such  that  it  arrives  at  a  lower  altitude  than 
expected.  These  results  are  consistent  with  those  reported  for  impulsive  RTMs  [94]. 


75 


Table  4.2:  Optimal  cost  in  m/s  of  low-thrust  single  pass  RTMs 


ro 

ae/be  {km) 

{km) 

(m/  sec) 

50/5 

60/6 

70/7 

80/8 

90/9 

100/10 

110/11 

120/12 

130/13 

140/14 

150/15 

6800 

AV 

1.380 

1.663 

1.951 

2.243 

2.545 

2.848 

3.164 

3.490 

3.829 

4.184 

4.556 

7300 

AV 

1.239 

1.492 

1.748 

2.009 

2.274 

2.556 

2.823 

3.141 

3.407 

3.709 

4.028 

The  costs  associated  with  low-thrust  RTMs  are  slightly  higher  than  those  seen  for 
impulsive  RTMs  with  similar  exclusion  ellipse  sizes,  which  is  expected.  The  cost  difference 
between  the  low-thrust  and  impulsive  cases  are  shown  in  Figure  4.4(a).  The  increased  AT 
required  for  low-thrust  RTMs  in  comparison  to  impulsive  RTMs  does  not  mean,  however, 
that  more  propellant  would  be  required. 

As  an  example,  consider  two  500  kg  spacecraft,  the  first  of  which  is  designed  to 
perform  impulsive  RTMs  and  is  equipped  with  a  currently  available  hydrazine  propulsion 
system  [101].  Such  a  propulsion  system  would  provide  a  specific  impulse  Isp  of 
approximately  235  s.  The  second  500  kg  spacecraft  would  require  continuous  one  Newton 
thrust  to  generate  the  required  for  low-thrust  RTMs. 

Figures  4.4(b)  and  4.4(c)  depict  the  difference  in  propellant  mass  expenditure  between 
low-thrust  and  impulsive  RTMs  as  functions  of  exclusion  ellipse  size  and  I^p  given  the 
proposed  propulsion  systems. 

A  current  flight  proven  low-thrust  propulsion  system  is  capable  of  delivering  the 
required  one  Newton  thrust  with  Isp  =  250  s  [102].  As  a  result.  Figures  4.4(b)  and  4.4(c) 
show  that  low-thrust  RTMs  enabled  by  the  flight-proven  low-thrust  system  [102]  provide 
minimal  benefit  to  impulsive  RTMs  in  terms  of  the  propellant  mass  required.  In  fact,  low- 
thrust  RTMs  require  more  propellant  than  impulsive  RTMs  for  Ug  >  130  km.  The  figures 
also  show,  however,  that  low-thrust  RTMs  will  result  in  significant  propellant  savings  as 
low-thrust  propulsion  efficiency  increases. 
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(a)  Difference  in  AV  between  impulsive  and  low-  (b)  Propellant  mass  savings  for  a  500  kg  satellite 
thrust  RTMs  (ro  =  6800  km) 


(c)  Propellant  mass  savings  for  a  500  kg  satellite 
(ro  =  7300  km) 

Figure  4.4:  Comparison  of  impulsive  and  low-thrust  single  pass  RTMs 


4.6.2  Double  Pass  Responsive  Theater  Maneuvers 

The  previously  deseribed  teehniques  were  applied  to  solve  double  pass  low-thrust 
RTMs  employing  the  same  initial  eonditions  used  in  the  single  pass  eases.  The  exelusion 
zone,  exelusion  ellipses,  and  apogee/perigee  eonstraints  also  remained  the  same  as  those 
investigated  in  the  single  pass  low-thrust  RTM  seenarios. 
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Two  PSO  algorithms  were  employed  in  series  to  obtain  initial  low-thrust  guesses  for 
the  DOC.  The  first  PSO  generated  feasible  low-thrust  trajectories  dependent  on  6i,v\,y\. 
Once  again,  Ti  =  ti-tQ.  The  output  from  the  first  PSO  run  specified  the  entry  conditions  for 
the  second  pass  over  the  exclusion  zone,  which  occurred  at  t2.  The  second  PSO  generated 
feasible  low-thrust  trajectories  dependent  on  62,  v^,  The  variable  T2  was  fixed  such 
that  T2  =  t2  -  ti,  where  t2  is  the  spacecraft’s  second  entry  time  into  the  exclusion  zone. 
The  serial  PS  Os  were  run  twenty  times  for  each  case  studied  with  bounds  on  the  design 
variables  as  shown  in  Equation  4.12. 


(4.12) 


The  results  from  the  impulsive  double  pass  RTM  scenarios  [94]  described  four 
locally  optimal  solutions.  These  locally  optimal  solutions  corresponded  to  permutations 
of  increasing  and  decreasing  altitude  for  the  first  and  second  maneuvers.  As  a  result,  the 
lowest-cost  solution  corresponding  to  each  permutation  was  chosen  as  an  initial  guess  into 
the  DOC.  For  all  cases,  any  permutation  of  increasing/decreasing  altitude  not  generated  by 
the  PSO  algorithms  was  initially  ignored. 

The  lowest-cost  output  from  the  PSO  algorithms  corresponding  to  each  possible 
maneuver  permutation  were  used  as  initial  guesses  for  a  run  of  the  DOC  consisting  of 
two  phases,  one  for  each  pass.  Each  phase  consisted  of  80  collocation  points.  The  output 
from  this  run  was  used  as  an  input  to  a  second  run  of  the  DOC  structured  identically  to 
the  first.  The  lower  bound  for  thrust  acceleration  was  set  equal  to  O.IA7  for  the  first 
run  of  the  DOC  and  zero  for  the  second.  If  the  DOC  did  not  yield  optimal  results  for  any 
case,  the  output  from  the  unused  serial  PSO  runs  corresponding  to  these  cases  were  used 
as  additional  initial  guesses.  This  approach  yielded  optimal  results  for  all  cases.  The  costs 
corresponding  to  these  solutions  are  shown  in  Table  4.3. 
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Table  4.3:  Optimal  cost  in  m/s  of  low-thrust  double  pass  RTMs 


ro 

fle/foe  (km) 

(km) 

(mj  sec) 

50/5 

60/6 

70/7 

80/8 

90/9 

100/10 

110/11 

120/12 

130/13 

140/14 

150/15 

AVi 

1.384 

1.663 

1.961 

2.255 

2.549 

2.850 

3.192 

3.490 

3.829 

4.241 

4.629 

6800 

^V2 

1.378 

1.671 

1.949 

2.239 

2.570 

2.878 

3.156 

3.540 

3.885 

4.170 

4.541 

J 

2.762 

3.334 

3.910 

4.494 

5.119 

5.728 

6.348 

7.030 

7.714 

8.411 

9.169 

AVi 

1.242 

1.497 

1.756 

2.009 

2.288 

2.546 

2.823 

3.109 

3.504 

3.764 

4.084 

7300 

^V2 

1.237 

1.490 

1.746 

2.025 

2.270 

2.568 

2.851 

3.164 

3.395 

3.700 

4.016 

J 

2.479 

2.987 

3.503 

4.035 

4.559 

5.114 

5.674 

6.273 

6.899 

7.454 

8.100 

Figure  4.5  shows  the  thrust  acceleration  and  switching  condition  along  with  the 
optimal  pointing  direction  for  each  maneuver  for  the  case  with  ro  =  6800  km  and 
ae  =  150  km.  The  figures  are  representative  of  the  other  double-pass  cases  considered. 


As  expected,  all  low-thrust  RTMs  require  more  AV  than  impulsive  RTMs  for  each 
scenario  investigated.  The  difference  in  AV  between  the  low-thrust  and  impulsive  cases  as 
functions  of  exclusion  ellipse  size  are  shown  in  Figure  4.6(a).  The  amount  of  propellant 
required  for  the  impulsive  and  low-thrust  RTMs  were  evaluated  using  the  same  propulsion 
systems  described  in  the  single  pass  case  and  the  results  are  similar.  Figures  4.6(b)  and 
4.6(c)  show  the  difference  in  propellant  mass  expenditure  between  impulsive  and  low-thrust 
RTMs  as  functions  of  exclusion  ellipse  size  and  l^p.  The  currently  available  low-thrust 
system  =  250  s)  implies  that  low-thrust  RTMs  provide  negligible  benefit  to  impulsive 
RTMs.  As  in  the  single-pass  cases,  however,  low-thrust  RTMs  will  provide  a  significant 
benefit  in  comparison  to  impulsive  RTMs  as  low-thrust  propulsion  efficiency  increases. 
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(d)  2"'^  maneuver  optimal  thrust  pointing 


Figure  4.5:  Optimal  control  necessary  conditions  for  double-pass  RTM  rg  =  6800  km, 
Ge  =  150  km 


4.6.3  Triple  Pass  Responsive  Theater  Maneuvers 
4.6.3. 1  Triple-Pass  Low-Thrust  RTMs 

Triple-pass  low-thrust  RTM  scenarios  employing  the  same  initial  conditions  used  in 
the  single  pass  cases  were  also  investigated.  The  exclusion  zone,  exclusion  ellipses,  and 
apogee/perigee  constraints  also  remained  the  same  as  those  investigated  in  the  single  and 
double-pass  scenarios. 
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(a)  Difference  in  AV  between  impulsive  and  low-  (b)  Propellant  mass  savings  for  a  500  kg  satellite 
thrust  RTMs  (ro  =  6800  km) 


(c)  Propellant  mass  savings  for  a  500  kg  satellite 
(ro  =  7300  km) 

Figure  4.6:  Comparison  of  impulsive  and  low-thrust  double  pass  RTMs 


Three  PSO  algorithms  employed  in  series  were  used  to  generate  feasible  initial  guesses 
to  the  DOC.  The  first  two  PSO  algorithms  employed  restrictions  on  T\  and  T2  identical 
to  those  described  in  the  single  and  double  pass  cases.  The  time  of  flight  for  the  third 
maneuver  was  fixed  at  one  orbital  period  of  the  initial  orbit.  This  restriction  was 
employed  because  the  scenarios  investigated  made  several  orbital  revolution  between  the 
second  and  third  passes  over  the  exclusion  zone.  Each  case  was  run  twenty  times  using  the 
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three  serial  PSO  algorithms.  The  serial  PSOs  were  run  twenty  times  for  each  case  studied 
with  bounds  on  the  design  variables  as  shown  in  Equation  4.13. 


<  9\,92,6'i  < 

<  v*,V2,v;  < 

<  < 


2n 

I  ^amax 
^Pmin  j  ^Pmin 

n 

2 


(4.13) 


The  initial  guesses  into  the  DOC  for  each  case  were  generated  by  choosing  the 
lowest  cost  solution  found  by  the  PSO  algorithms  which  corresponded  to  each  possible 
permutation  of  increasing  and  decreasing  altitude.  Any  permutation  not  converged  upon 
by  the  PSO  algorithms  was  ignored.  The  trajectories  resulting  from  the  PSO  runs  seeded 
an  initial  run  of  the  DOC  consisting  of  four  phases.  The  first  two  phases  were  for  the  first 
two  passes,  the  third  phase  imposed  a  mandatory  coast  during  the  second  pass  through 
the  zone,  and  the  final  phase  represented  the  time  from  the  second  exit  to  the  third  entry 
into  the  exclusion  zone.  The  first  three  phases  were  discretized  into  80  collocation  points 
while  the  fourth  phase  consisted  of  320  collocation  points.  The  increase  in  the  number  of 
collocation  points  for  the  fourth  phase  was  meant  to  account  for  the  relative  length  of  the 
final  phase  in  comparison  to  the  first  three.  The  output  from  the  initial  run  of  the  DOC  was 
used  as  an  initial  guess  for  a  second  run  of  the  DOC  structured  identically  to  the  first.  The 
thrust  lower  bound  was  set  equal  to  0.  for  the  first  run  and  zero  for  the  second.  If 
the  DOC  did  not  yield  optimal  results  for  any  case,  the  output  from  the  unused  serial  PSO 
runs  corresponding  to  these  cases  were  used  as  additional  initial  guesses.  The  approach 
described  above  generated  optimal  results  for  all  of  the  triple  pass  cases  investigated  in  this 
research.  The  optimal  costs  for  each  case  are  shown  in  Table  4.4. 


Figure  4.7  shows  the  thrust  acceleration  and  switching  condition  along  with  the 
optimal  pointing  direction  for  each  maneuver  for  the  case  with  vq  =  6800  km  and 
Ue  =  150  km.  The  figures  are  representative  of  those  seen  for  the  other  cases. 
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Table  4.4:  Optimal  cost  in  m/s  of  low-thrust  triple  pass  RTMs 


ro 

fle/foe  (km) 

(km) 

(mj  sec) 

50/5 

60/6 

70/7 

80/8 

90/9 

100/10 

110/11 

120/12 

130/13 

140/14 

150/15 

AVi 

1.384 

1.667 

1.964 

2.260 

2.563 

2.875 

3.196 

3.530 

3.878 

4.244 

4.559 

^V2 

1.390 

1.676 

1.952 

2.244 

2.542 

2.847 

3.162 

3.486 

3.824 

4.175 

4.649 

6800 

AVa 

0.483 

0.573 

0.663 

0.752 

0.842 

0.932 

1.022 

1.111 

1.201 

1.290 

1.379 

J 

3.257 

3.916 

4.579 

5.256 

5.947 

6.653 

7.379 

8.127 

8.903 

9.710 

10.587 

AVi 

1.247 

1.502 

1.753 

2.024 

2.293 

2.549 

2.850 

3.141 

3.443 

3.757 

4.086 

<1 

1.243 

1.495 

1.764 

2.011 

2.276 

2.573 

2.822 

3.106 

3.399 

3.703 

4.021 

7300 

AVa 

0.500 

0.594 

0.689 

0.784 

0.879 

0.974 

1.069 

1.165 

1.261 

1.356 

1.453 

J 

2.989 

3.591 

4.205 

4.819 

5.448 

6.096 

6.742 

7.412 

8.104 

8.816 

9.560 

The  results  for  the  triple  pass  cases  are  notable  and  provide  additional  insight  into 
the  RTM  problem  not  seen  in  the  single  and  double-pass  results.  This  insight  results  from 
the  spacecraft  having  several  orbits  to  complete  the  final  maneuver  versus  a  single  orbit 
to  complete  the  first  and  second  maneuvers.  Consequently,  the  optimal  third  maneuver 
found  for  each  case  was  a  short  bum  immediately  after  the  spacecraft  exited  the  exclusion 
zone  for  the  second  time  followed  by  a  long  coasting  period.  These  relatively  small 
maneuvers  produce  dramatic  effects  after  multiple  orbits  due  to  the  differences  in  mean 
motion  between  the  nominal  and  post-maneuver  trajectories.  The  initial  conditions  for  the 
single  and  double-pass  scenarios  do  not  allow  for  these  long  drift  times. 

Additionally,  the  fact  that  the  DOC  converged  to  these  specific  solutions  is  significant 
due  to  the  nature  of  the  initial  guess  provided  by  the  shape-based  method.  Recall  that  the 
shape-based  trajectories  generated  by  the  PSO  algorithms  used  a  fixed  maneuver  time  for 
each  orbit.  The  maneuver  time  for  the  final  orbit  Tj,  was  fixed  at  one  orbital  period,  which 
implies  that  the  PSO  generated  solutions  in  which  the  maneuvers  took  place  during  the 
last  Ta  s  of  the  allowable  maneuvering  time.  That  is,  the  third  maneuver  was  constrained 
such  that  it  occurred  on  the  last  of  several  orbits  between  the  second  exit  out  of  and  third 
entry  into  the  exclusion  zone.  The  DOC,  despite  this  initial  guess,  converged  to  optimal 
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trajectories  in  which  the  maneuver  occurred  immediately  after  the  spacecraft  exited  the 
exclusion  zone  for  the  second  time.  This  demonstrates  the  robustness  of  the  technique 
described  in  this  research  with  respect  to  low-thrust  RTMs. 

4.6.3. 2  Triple-Pass  Multiple-Revolution  Impulsive  RTMs 

It  was  desirable  to  compare  the  low-thrust  triple  pass  RTM  results  shown  in  Table  4.4 
to  comparable  impulsive  maneuvers.  The  triple  pass  results  presented  in  [94],  however, 
restricted  the  impulsive  maneuvers  to  take  less  than  one  orbital  revolution.  As  a  result,  the 
third  maneuver  in  the  triple-pass  sequences  did  not  take  advantage  of  the  long  drift  time 
between  the  second  and  third  passes  over  the  exclusion  zone. 

In  order  to  provide  relevant  comparisons  to  the  low-thrust  data  in  Table  4.4,  new 
solutions  were  generated  for  the  impulsive  triple-pass  RTMs  which  allowed  for  multiple 
revolution  maneuvers.  The  initial  conditions  and  constraints  for  the  multiple  revolution 
impulsive  maneuvers  were  identical  to  those  presented  for  the  low-thrust  triple-pass 
RTM  problem.  A  Lambert  targeting  algorithm  provided  in  [41]  can  generate  impulsive 
maneuvers  that  complete  greater  than  one  revolution  around  the  earth  provided  the  desired 
number  of  revolutions  Nrev  are  defined.  For  the  purposes  of  this  research,  Nrev  for  a 
responsive  theater  maneuver  is  found  by  dividing  T^  hy  the  period  of  the  nominal  orbit 
and  rounding  down  to  the  nearest  integer  value.  This  algorithm  was  employed  inside  a 
PSO  to  produce  optimal  triple  pass  RTMs  for  the  given  problems. 

Experimentation  with  several  global  and  local  PSO  algorithms  led  to  choosing  a  local 
PSO  variant  to  optimize  triple-pass  multiple-revolution  RTMs.  The  PSO  employed  a 
population  of  200  particles,  neighborhood  size  of  30  and  a  maximum  of  5000  iterations. 
Additional  stopping  conditions  were  set  such  that  the  algorithm  was  considered  to  converge 
if  75%  of  the  particles  had  the  same  cost  or  it  the  lowest  cost  found  by  the  swarm  had 
not  changed  in  1000  consecutive  iterations.  All  other  PSO  parameters  were  identical  to 
those  shown  in  Table  5.2.  The  PSO  was  not  tuned  to  optimize  computational  performance 
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because  the  purpose  for  solving  multiple-revolution  impulsive  RTMs  was  for  comparison 
purposes  only. 

All  but  one  combination  of  initial  orbit  size  and  exclusion  ellipse  size  was  optimized 
ten  times.  The  case  with  tq  =  6800  km  and  Ug  =  120  km  was  optimized  thirteen  times  to 
generate  results  consistent  with  the  other  cases.  The  lowest  cost  in  each  case  is  hereafter 
referred  to  as  the  minimum  and  each  can  be  seen  in  Table  4.5.  Notice  that  the  AT 
required  for  the  third  maneuver  is  much  smaller  than  that  required  for  the  first  and  second 
maneuvers.  The  smaller  magnitude  of  the  third  maneuver  results  from  the  spacecraft  having 
several  orbits,  and  thus  more  time,  to  complete  the  final  maneuver.  As  a  result,  a  relatively 
small  burn  produces  a  change  in  the  mean  motion  of  the  spacecraft.  The  small  change  in 
mean  motion  propagated  over  several  orbits  allows  the  spacecraft  to  arrive  on  the  exclusion 
ellipse  at  the  desired  arrival  time  for  significantly  less  AT  than  required  for  maneuvers 
occurring  in  fewer  orbital  revolutions. 


Table  4.5:  Optimal  cost  in  m/s  of  impulsive  triple  pass  RTMs 


'■o 

Uglbg  (km) 

(km) 

(mj  sec) 

50/5 

60/6 

70/7 

80/8 

90/9 

100/10 

110/11 

\lQj\l 

130/13 

140/14 

150/15 

AVi 

1.365 

1.645 

1.921 

2.195 

2.449 

2.748 

3.020 

3.276 

3.549 

3.847 

4.130 

AV, 

1.367 

1.636 

1.910 

2.181 

2.451 

inn 

2.993 

3.318 

3.586 

3.803 

4.073 

6800 

<1 

3.1e-3 

6.7e-5 

1.9e-4 

1.3e-4 

8.7e-5 

le-4 

1.7e-4 

4e-4 

9.9e-5 

3. le-4 

9.9e-5 

J 

2.735 

3.281 

3.831 

4.376 

4.920 

5.471 

6.013 

6.594 

7.135 

7.650 

8.203 

AVi 

1.234 

1.480 

1.729 

1.973 

2.223 

2.472 

2.718 

2.962 

3.211 

3.520 

3.697 

AV, 

1.227 

1.472 

1.735 

1.960 

2.216 

2.428 

2.704 

2.934 

3.266 

3.486 

3.732 

7300 

<1 

6.8e-5 

2.6e-5 

2.9e-4 

1.6e-4 

5.8e-5 

9.3e-5 

9.7e-5 

1.9e-4 

8.7e-4 

le-4 

2.8e-4 

J 

2.461 

2.952 

3.464 

3.933 

4.439 

4.920 

5.423 

5.896 

6.477 

6.936 

7.429 

4.63.3  Comparison  of  Triple-Pass  Low-Thrust  and  Impulsive  RTMs 
The  Ay  required  for  the  impulsive  triple-pass  RTM  scenarios  were  less  than  that  of 
their  low-thrust  counterparts,  which  is  consistent  with  the  single  and  double-pass  results. 
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The  triple-pass  results  are  distinct,  however,  because  the  impulsive  version  is  more  efficient 
with  respect  to  propellant  consumption  for  all  exclusion  ellipse  sizes  given  the  current  state 
of  propulsion  systems  discussed  in  Section  4.6.1.  Once  again,  low-thrust  RTMs  have  the 
potential  to  provide  significant  propellant  savings  in  comparison  to  impulsive  RTMs  given 
increases  in  low-thrust  propulsion  efficiency.  Figure  4.8(a)  shows  the  difference  in  AV 
between  the  impulsive  and  low-thrust  results.  Figures  4.8(b)  and  4.8(c)  show  the  potential 
propellant  mass  savings  in  kg  for  low-thrust  RTMs  in  comparison  to  impulsive  RTMs  as 
functions  of  exclusion  ellipse  size  and  low-thrust  I^p. 

4.7  Conclusion 

Implementing  PSO  algorithms  to  generate  shape-based  low-thrust  trajectory  approxi¬ 
mations  as  initial  guesses  for  a  direct  orthogonal  collocation  method  employing  a  nonlinear 
programming  problem  solver  was  both  effective  and  robust  in  generating  low-thrust  respon¬ 
sive  theater  maneuvers  satisfying  the  analytical  necessary  conditions  for  an  optimal  control. 
The  technique  was  able  to  generate  low-thrust  maneuvers  for  two  distinct  initial  orbits  and 
for  exclusion  ellipses  of  varying  size  for  single,  double  and  triple  pass  responsive  theater 
maneuver  scenarios.  These  low-thrust  maneuvers  required  delta-velocities  on  the  order  of 
meters  per  second  and  are  only  slightly  larger  than  those  resulting  from  impulsive  maneu¬ 
vers  designed  to  achieve  the  same  resiliency  effects.  As  low-thrust  propulsion  technology 
progresses,  however,  engine  efficiency  is  expected  to  improve.  While  other  factors  such  as 
power  requirements  and  duty  cycle  must  be  considered,  this  improved  efficiency  will  make 
low-thrust  responsive  theater  maneuvers  significantly  more  efficient  than  their  impulsive 
counterparts.  Further,  these  techniques  can  be  extended  to  longer  and  more  complex  sce¬ 
narios  which  require  a  spacecraft  to  perform  several  additional  maneuvers.  These  results 
provide  a  methodology  to  develop  and  optimize  maneuvers  which  increase  the  resiliency 
of  spacecraft  operating  in  hazardous  environments. 
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(a)  P'  maneuver  Aj-  magnitude  and  switching  func¬ 
tion 


(b)  1  maneuver  optimal  thrust  pointing 
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(d)  2'“^  maneuver  optimal  thrust  pointing 


S  X  10 

^  3| - 


■2  2 
n 

S  1 


^  1.5  2  2.5  3  3.5  4  4.5 

^  Time  (sec)  , . 


(e)  3'^“'  maneuver  Aj  magnitude  and  switching  func¬ 
tion 


(f)  3'^“'  maneuver  optimal  thrust  pointing 


Figure  4.7:  Optimal  control  necessary  conditions  for  triple-pass  RTM  ro  =  6800  km, 
Ge  =  150  km 
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A  V  Difference  (m/sec) 


(a)  Difference  in  AV  between  impulsive  and  low-  (b)  Propellant  mass  savings  for  a  500  kg  satellite 
thrust  RTMs  (ro  =  6800  km) 


(c)  Propellant  mass  savings  in  for  a  500  kg  satellite 
(ro  =  7300  km) 

Figure  4.8:  Comparison  of  impulsive  and  low-thrust  triple  pass  RTMs 
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4.8  Appendix:  Coordinate  Transformation  Matrices 


(r)  = 


R2(t)  = 


R3(r)  = 


1  0  0 
0  cos  r  sin  t 

0  -  sin  r  cos  t 

cos  T  0  -  sin  T 
0  1  0 
sin  T  0  cos  r 

cos  T  sin  T  0 
-  sin  T  cos  T  0 
0  0  1 


(4.14) 


(4.15) 


(4.16) 
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V.  Optimal  Geostationary  Transfer  Maneuvers  with  Cooperative  En-route 
Inspection  Using  Hybrid  Optimal  Control 


5.1  Abstract 

This  research  investigates  the  performance  of  bi-level  hybrid  optimal  control 
algorithms  in  the  solution  of  minimum  delta-velocity  geostationary  transfer  maneuvers 
with  cooperative  en-route  inspection.  The  maneuvers,  introduced  here  for  the  first  time,  are 
designed  to  populate  a  geostationary  constellation  of  space  situational  awareness  satellites 
while  providing  additional  characterization  of  objects  in  lower- altitude  orbit  regimes.  The 
maneuvering  satellite,  called  the  chaser,  performs  a  transfer  from  low  Earth  orbit  to 
geostationary  orbit.  During  the  transfer,  the  chaser  performs  an  inspection  of  one  of  several 
orbiting  targets  in  conjunction  with  a  ground  site  for  the  duration  of  the  target’s  line-of-sight 
contact  with  the  ground  site.  The  chaser’s  orbit  during  the  inspection  is  constrained  such 
that  it  remains  inside  a  cylindrical  inspection  volume  relative  to  the  target  for  the  duration  of 
the  target’s  pass  over  the  ground  site.  The  long  axis  of  the  cylindrical  volume  is  aligned  with 
the  vector  connecting  the  ground  site  to  the  target  for  the  duration  of  the  inspection.  The 
chaser  is  allowed  to  transfer  to  its  final  orbit  upon  completion  of  the  cooperative  inspection. 
A  three  target  example  is  optimized  to  test  the  performance  of  multiple  bi-level  hybrid 
optimal  control  algorithms.  Bi-level  algorithms  employing  complete  data  repositories 
are  shown  to  generate  near-optimal  solutions  in  significantly  shorter  computational  time 
than  complete  enumeration  of  the  problem  space.  A  hybrid  algorithm  employing  a  data 
repository  and  two  particle  swarm  optimization  algorithms  is  then  utilized  to  optimize  a 
fifteen  target  geostationary  transfer  maneuver  with  cooperative  en-route  inspection.  Results 
indicate  that  the  bi-level  algorithm  is  effective  for  larger  dimensional  problems  and  that 
these  maneuvers  can  be  accomplished  for  a  fraction  more  delta- velocity  than  that  which  is 
required  for  a  simple  transfer  to  geostationary  orbit  given  the  same  initial  conditions. 
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5.2  Nomenclature 


l-GEO 


„c  „c  „c 
'  IJK^  '  RSW’  '  CYL 


’UK 


'  UK 


Ra 


^enter’’  ^exit 


to 


h 


h 

U 

t’^UK'  t^RSW 

a 

j8 

6^’ 


true  longitude  at  epoch  of  the  arrival  location  on  the 
geostationary  orbit,  rad 

position  vectors  of  the  chaser  in  the  inertial,  local  vertical,  local 
horizontal,  cylinder  coordinate  frames,  km 
inertial  position  vector  of  the  ground 
site,  km 

inertial  position  vector  of  the  mth  target 
radius  of  the  earth,  km 
maneuver  completion  time,  sec 

entry,  exit  times  of  the  mth  target’s  kth.  pass  over  the  ground  site,  sec 
latest  time  to  initiate  cooperative  inspection  segment,  sec 
initial  time,  sec 

time  of  initial  impulsive  maneuver  to  cooperative  inspection 
segment,  sec 

time  of  fight  for  maneuver  from  initial  orbit  to  cooperative 
inspection  segment,  sec 

coast  time  following  cooperative  inspection  phase,  sec 
time  of  flight  for  maneuver  to  the  final  mission  orbit,  sec 
velocity  vectors  of  the  chaser  in  the  inertial,  and  local  vertical, 
local  horizontal  coordinate  frames,  km 

angle  measured  from  the  orbital  plane  to  the  cylinder  in  the  local 
vertical,  local  horizontal  frame,  rad 

angle  measured  from  the  primary  axis  to  the  cylinder  in  the  local 
vertical,  local  horizontal  frame,  rad 

elevation  angle  of  the  chaser  with  respect  to  the  ground  site,  rad 
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d,. 


6 


m 


(p,  A 


COq 

Q™’",  M™’" 


P/7/fj  Prsw^  Psez 


Prsw^  Prsw^  Prsw 


Psez 


maximum  allowable  elevation  angle  of  the  chaser  with  respect 
to  the  ground  site,  rad 

minimum  elevation  angle  required  by  ground  site  for  line-of-sight 

contact  with  the  mth  target,  rad 

elevation  angle  of  the  target  satellite,  rad 

geocentric  latitude  and  longitude,  rad 

rotation  rate  of  the  earth,  rad 

inclination,  right  ascension  of  the  ascending  node,  argument  of 
latitude  of  the  target,  chaser  rad 

vector  connecting  ground  site  to  the  target  in  inertial,  local 
vertical,  local  horizontal,  and  topocentric  horizon  coordinate 
frames,  km 

components  of  the  vector  connecting  ground  site  to  the  target  in 
the  R,  S  ,W  directions  of  the  local  vertical,  local  horizontal 
coordinate  frame,  km 

zenith  component  of  the  vector  connecting  ground  site  to  the 
target  in  the  topocentric  horizon  coordinate  frame,  km 


5.3  Motivation 

The  United  States  Department  of  Defense  (DoD)  and  Office  of  the  Director  of  National 
Intelligence  released  the  National  Security  Space  Strategy  (NSSS)  in  2011.  The  document 
highlights  the  increasing  number  of  man-made  objects  in  space  as  well  as  the  increasing 
number  of  nations  owning  or  operating  satellites  [2].  As  of  2010,  there  were  over  1, 500 
active  satellites  orbiting  the  Earth.  The  DoD  tracks  these  satellites  along  with  nearly  20, 000 
other  man-made  objects  in  order  to  provide  space  situational  awareness  (SSA)  to  all  nations 
using  space.  Despite  these  efforts,  the  DoD  estimates  that  there  are  “hundreds  of  thousands 
of  additional  objects  that  are  too  small  to  track”  [2].  The  current  congestion  in  all  orbital 
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regimes  poses  an  increasing  threat  to  the  safety  of  active  satellites,  as  highlighted  by  the 
2009  collision  of  a  Russian  Cosmos  satellite  with  an  Iridium  satellite  [2].  The  problem 
of  congestion  will  only  increase  as  more  objects  are  launched  into  space.  As  a  result,  the 
NSSS  lists  SSA  as  its  top  priority,  citing  the  need  to  improve  both  the  quantity  and  quality 
of  SSA  information  to  better  characterize  natural  disturbances  as  well  as  the  capabilities 
and  intentions  of  other  space  fairing  nations  [2]. 

Ziegler  [103]  noted  that  the  vast  majority  of  current  SSA  capability  is  provided  by 
ground-based  sensors,  which  are  essentially  limited  to  “counting  and  cataloging  space 
objects.”  Tirpak  highlighted  current  SSA  capability  gaps  which  include  inadequate 
characterization  of  events  occurring  outside  the  view  of  sensors,  weather  dependent  optical 
observations,  and  a  lack  of  high  quality  data  in  the  geosynchronous  orbit  regime  [104]. 
Recent  research  has  proposed  space-based  SSA  platforms  in  the  form  of  nanosatellite 
clusters  positioned  in  various  orbital  regimes  [103]  and  constellations  of  satellites  operating 
in  or  near  the  geosynchronous  belt  [105]  in  order  to  augment  current  capabilities  and 
provide  characterization  of  objects. 

This  work  proposes  a  new  type  of  maneuver  to  enable  higher  fidelity,  space-based 
SSA.  This  maneuver,  called  the  geostationary  transfer  maneuver  with  cooperative  en-route 
inspection  (GTMEI),  requires  a  maneuvering  spacecraft  to  inspect  of  one  of  several  orbiting 
targets  before  completing  a  transfer  to  a  geostationary  mission  orbit.  The  inspection  is 
performed  in  cooperation  with  a  designated  ground  site  and  lasts  for  the  duration  of  the 
target’s  line-of-sight  contact  with  the  site.  The  GTMEI  has  the  added  benefit  that  the 
maneuvering  satellite  could  be  used  to  populate  a  GEO-based  SSA  constellation  such  as 
those  proposed  in  [105]  while  also  providing  characterization  of  targets  in  lower  orbital 
regimes.  This  research  employs  hybrid  optimal  control  (HOC)  algorithms  to  generate 
minimum  fuel  GTMEI  with  target  populations  of  varying  size. 
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5.4  Background 

HOC  problems  consist  of  combinations  of  categorical  variables  and  continuous 
variables.  HOC  algorithms  are  particularly  interesting  because  they  enable  high  level 
autonomous  decision  making  and  can  be  applied  to  a  variety  of  real  world  engineering 
problems.  Recent  research  on  the  use  of  HOC  in  spacecraft  trajectory  optimization  [28- 
31,  87,  88]  has  focused  on  bi-level  HOC  algorithms  with  multiple  uses  for  the  categorical 
variables.  One  use  for  the  categorical  variables  is  to  select  a  planet  to  use  for  a  gravity- 
assist  or  an  asteroid  with  which  to  rendezvous  [28-31].  A  second  use  for  the  categorical 
variables  is  to  define  the  number  and  sequence  of  the  maneuvers  to  be  performed  [30,  31]. 
Finally,  recent  research  has  focused  on  using  the  categorical  variables  to  determine  the  type 
of  maneuvers  to  be  performed,  in  addition  to  their  number  and  sequence  [87,  88].  In  all 
cases,  the  structure  defined  by  the  categorical  variables  completely  defines  the  inner- loop 
optimization  problem. 

Conway  et  al.  [28]  formulated  an  HOC  problem  in  the  solution  of  a  three  asteroid 
interception  mission.  A  maneuvering  spacecraft  with  impulsive-only  thrust  capability  was 
required  to  intercept  three  of  a  possible  eight  asteroids  with  minimum  fuel.  The  authors 
compared  two  bi-level  algorithms.  The  first  employed  a  genetic  algorithm  (GA)  as  the 
outer-loop  solver  and  an  inner-loop  solver  consisting  of  direct  transcription  with  Runge- 
Kutta  implicit  integration  (DTRK)  parallel  shooting.  The  second  algorithm  employed 
a  branch  and  bound  (B&B)  outer-loop  solver  with  a  GA  inner-loop  solver.  Complete 
enumeration  was  used  to  determine  the  optimal  sequence  and  cost.  The  GA-DTRK 
found  the  optimal  solution  while  requiring  only  a  fraction  of  the  number  of  cost  function 
evaluations  required  for  complete  enumeration  of  the  problem  space.  The  B&B-GA  located 
similar  solutions  to  those  found  by  the  GA-DTRK  algorithm  with  even  fewer  cost  function 
evaluations. 
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Wall  and  Conway  [29]  examined  the  low-thrust  version  of  the  minimum  fuel  asteroid 
rendezvous  problem  defined  in  [28].  The  authors  used  a  shape-based  approximation  to 
generate  feasible  low-thrust  trajectories  with  defined  boundary  conditions.  They  compared 
the  performance  of  a  bi-level  HOC  algorithm  with  a  B&B  outer-loop  solver  coupled  with  a 
GA  inner-loop  to  that  of  a  GA  outer-loop  coupled  with  an  inner-loop  GA.  Once  the  outer- 
loop  algorithms  terminated,  the  best  trajectories  found  by  each  hybrid  algorithm  were  used 
as  initial  guesses  for  a  DTRK  method.  [29]  implemented  a  bi-level  GA-GA  algorithm  to 
solve  a  larger  asteroid  rendezvous  in  which  a  spacecraft  must  rendezvous  with  one  asteroid 
in  each  of  four  groups  of  asteroids.  Once  again,  the  best  solutions  generated  by  the  GA-GA 
algorithm  with  shape-based  approximation  were  used  as  initial  guesses  for  a  more  accurate 
DTRK  method.  The  solutions  found  with  the  GA-GA  algorithm  very  nearly  approximated 
the  optimal  solutions  identified  by  the  DTRK  and  required  significantly  less  computational 
time  to  generate. 

Englander  et  al.  [30]  used  a  bi-level  HOC  algorithm  to  optimize  interplanetary 
transfers  with  unknown  locations,  numbers,  and  sequences  of  en-route  flybys.  The  outer- 
loop  utilized  a  GA  to  determine  the  number,  location,  and  sequence  of  fly-bys,  while  the 
inner-loop  employed  a  combination  of  particle  swarm  optimization  (PSO)  and  differential 
evolution  (DE)  to  optimize  the  variables  corresponding  to  the  sequences  generated  by  the 
outer-loop.  The  authors  applied  this  algorithm  to  three  problems:  an  impulsive  multi 
gravity  assist  (MGA)  transfer  from  Earth  to  Jupiter,  an  impulsive  MGA  transfer  from  Earth 
to  Saturn,  and  an  impulsive  MGA  with  deep  space  maneuver  transfer  from  Earth  to  Saturn. 

Englander  et  al.  [31]  extended  the  work  in  [30]  by  adding  a  capability  to  model 
low-thrust  trajectories.  They  utilized  a  bi-level  algorithm  consisting  of  an  outer-loop  GA 
coupled  with  an  inner-loop  monotomic  basin  hopping  (MBH)  algorithm.  The  result  from 
the  MBH  algorithm  was  used  as  an  initial  guess  to  a  Sims-Elanagan  transcription  algorithm 
used  to  generate  low-thrust  trajectories.  The  authors  applied  this  algorithm  to  generate 
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optimal  trajectories  for  an  Earth  to  Jupiter  transfer  employing  nuclear  electric  propulsion, 
an  early  proposal  for  the  BepiColombo  mission  to  Mercury,  and  a  solar-electric  mission 
from  Earth  to  Uranus. 

Chilan  and  Conway  [87]  introduced  a  new  use  for  HOC  in  spacecraft  trajectory 
optimization  by  using  the  categorical  variables  to  define  the  number,  types,  and  sequence  of 
maneuvers  to  be  performed  between  defined  boundary  conditions.  They  implemented  a  bi¬ 
level  HOC  algorithm  with  a  GA  outer- loop  solver  combined  with  a  nonlinear  programming 
(NEP)  inner-loop  solver.  The  inner-loop  solver  was  seeded  with  an  initial  guess  using 
feasible  region  analysis  and  the  conditional  penalty  (CP)  method.  [87]  also  demonstrated 
the  effectiveness  of  the  algorithm  by  solving  a  minimum-fuel,  time-fixed  rendezvous 
between  circular  orbits  originally  posed  by  Prussing  and  Chui  [89] .  The  algorithm  proposed 
in  [87]  generated  the  optimal  solution  found  by  Colasurdo  and  Pastrone  [90]. 

In  a  subsequent  work,  Chilan  and  Conway  [88]  used  a  bi-level  HOC  employing  a 
GA  outer-loop  solver  coupled  with  an  NEP  inner-loop  solver  which  was  seeded  by  a 
GA  employing  the  CP  method.  They  applied  this  algorithm  to  the  time-fixed  rendezvous 
problem  posed  in  [89]  and  found  a  low-thrust  trajectory  which  had  a  lower  cost  than,  but 
was  analogous  to  the  best  impulsive  solution  found  in  [90].  [88]  applied  the  same  bi-level 
HOC  to  find  a  minimum  fuel,  free  final  time  trajectory  from  Earth  to  Mars. 

Yu  et  al.  [91]  developed  a  bi-level  HOC  algorithm  to  determine  optimal  trajectories  for 
several  variants  of  a  GEO  debris  removal  problem.  They  compared  the  performance  of  a 
simulated  annealing  (SA)  outer-loop  solver  coupled  with  a  GA  to  that  of  an  exhaustive 
search  coupled  with  a  GA  to  solve  the  inner-loop  problem.  Additionally,  the  authors 
developed  a  so-called  rapid  method  for  the  outer-loop  solver  and  found  that  it  generated 
similar  solutions  to  that  of  the  SA  outer-loop  solver,  but  required  much  less  computational 
time. 
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This  research  employs  HOC  algorithms  to  generate  minimum  fuel  solutions  to  the 
GTMEI.  The  GTMEI  is  designed  to  deliver  an  SSA  platform  from  low  Earth  orbit 
(LEO)  to  geostationary  orbit  while  performing  a  cooperative  inspection  of  one  of  a  set 
of  uncharacterized  targets  while  en-route  to  the  geostationary  orbit  belt,  where  it  will  serve 
as  a  space-based  SSA  platform.  The  categorical  variables  are  used  to  designate  a  specific 
target  and  pass  for  the  cooperative  inspection.  This  inspection  is  defined  such  that  the  SSA 
platform  is  in  a  relative  orbit  with  the  designated  object  for  the  duration  of  the  object’s 
line-of-sight  contact  with  a  specified  ground  station. 

The  relative  motion  segment  of  the  maneuver  relies  on  the  linearized  equations  of 
motion  originally  proposed  by  Hill  [44]  and  Clohessy  and  Wiltshire  [45].  Recent  research 
in  the  field  of  relative  spacecraft  motion  has  focused  on  constraining  the  motion  of  the 
chaser  inside  a  specified  area  or  volume  defined  in  relation  to  the  target.  Hope  and  Trask 
[106]  proposed  a  pogo  orbit  that  intersects  itself  in  the  local  vertical,  local  horizontal 
coordinate  frame  (RSW),  allowing  the  chaser  to  perform  single  impulsive  burns  at  the 
intersection  to  maintain  a  “hover”  relative  to  the  target.  [106]  restricted  the  motion  of  the 
chaser  such  that  it  stayed  in  the  orbital  plane  of  the  target.  Irvin  et  al.  [46]  developed  a 
more  general  framework  in  which  the  chaser’s  motion  was  constrained  inside  an  elliptical 
cylinder  fixed  relative  to  the  target.  [46]  also  presented  a  method  to  determine  the  chaser’s 
initial  and  final  relative  velocities  given  its  initial  and  final  relative  positions  and  the  time 
of  flight  between  them. 

This  research  extends  the  work  in  [46]  by  defining  a  volume  that  moves  in  the  RSW 
frame  with  respect  to  the  target  satellite  as  it  passes  over  the  ground  site.  The  GTMEI 
requires  the  chaser  to  remain  inside  the  moving  volume  for  the  duration  of  the  cooperative 
inspection  segment,  which  lasts  while  the  target  is  in  view  of  a  designated  ground  site. 
Once  the  cooperative  inspection  is  complete,  the  maneuvering  SSA  platform  can  initiate  a 
transfer  to  the  final  geostationary  orbit. 
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5.5  Geostationary  Transfer  Maneuver  with  En-route  Inspection 

The  GTMEI  requires  a  chaser  to  transfer  from  a  circular  parking  orbit  to  a  final 
geostationary  mission  orbit.  The  chaser  performs  two  impulsive  maneuvers  to  place  it 
in  relative  motion  with  the  mth  of  M  targets  for  the  duration  of  the  target’s  kth  horizon- 
to-horizon  contact  with  the  ground  site,  which  is  defined  by  its  geocentric  latitude  (p  and 
longitude  A.  The  motion  of  the  chaser  during  the  cooperative  inspection  is  restricted  to 
a  cylindrical  volume  relative  to  the  target,  the  axis  of  which  is  coincident  with  the  vector 
connecting  the  ground  site  to  the  target.  The  chaser  then  performs  two  additional  impulsive 
maneuvers  upon  completion  of  the  cooperative  inspection  segment  which  deliver  it  to  the 
final  mission  orbit.  The  selection  of  a  specific  target  m  and  pass  k  determines  the  start  and 
end  times  of  the  relative  motion  segment  and  the  initial  and  final  positions  of  the  moving 
cylinder.  The  chaser  completes  the  entire  transfer  from  the  initial  to  the  final  orbit  in  three 
segments:  impulsive  transfer  to  target,  cooperative  inspection,  and  impulsive  transfer  to 
geostationary  orbit. 

5.5.1  Cooperative  Inspection  Boundary  Conditions 

The  problem  begins  at  initial  time  to,  assumed  zero  without  loss  of  generality.  The  mth 
target  begins  in  a  circular  orbit  with  a  state  defined  by  its  semi-major  axis  a™,  inclination 
right  ascension  of  the  ascending  node  Q!^,  and  argument  of  latitude  u'”  (to)  at  to-  The 
initial  state  of  the  ground  site  is  defined  by  (p.  A,  and  the  site’s  Greenwich  mean  standard 
time  at  to,  hereafter  set  equal  to  A  for  simplicity.  The  target’s  state  is  propagated  forward 
using  Kepler’s  equation  from  to  to  a  maximum  time  t^ax  and  the  state  of  the  ground  site  is 
propagated  according  to  a  spherical  Earth  assumption  in  order  to  determine  the  number  of 
target  passes  over  the  ground  site.  The  inertial  position  vector  of  the  ground  site  at  any 


98 


time  t  is 

i?®  cos  <p  cos  (A  +  a»®0 

~  7?®  cos  ^  cos  (A  +  a»®0  (5.1) 

i?®  sin  (p 

Where,  7?®  and  m®  are  the  radius  and  the  rotation  rate  of  the  Earth,  respectively.  The 
position  vector  of  the  target  at  time  t  is  (t)  and  can  be  found  using  the  target’s  initial 
orbital  elements  and  Kepler’s  equation.  The  vector  originating  at  the  ground  site  and 
pointing  to  the  target  is 

pijK  (t)  =  rfjj.  (t)  -  rjjj^  (t)  (5.2) 

Equation  5.3  defines  the  rotation  of  a  vector  from  the  inertial  frame  to  the  topocentric 
horizon  coordinate  frame  (SEZ)  frame  centered  at  the  ground  site  [36,  pp.  175]. 

p,ez  (t)  =  R2  (nil  -  (/))  R3  (A  +  coQt)puK  (t)  (5.3) 

Where  Rl,  R2,  and  R3  are  right  handed  rotation  matrices  about  an  angle  r  and  are  defined 
in  Equations  5.4,  5.5,  and  5.6. 

1  0  0 

i?l  (r)  =  0  COST  sinr  (5.4) 

0  -  sin  r  cos  r 

cos  T  0  -  sin  T 

R2(t)=  0  1  0  (5.5) 

sin  T  0  cos  r 

cos  T  sin  T  0 

R3(t)=  -sinr  cost  0  (5.6) 

0  0  1 

The  times  at  which  the  target  is  in  view  of  the  ground  station  in  the  interval  from  to  to 
tmax  can  be  determined  at  discrete  time  steps  by  evaluating  the  target’s  elevation  angle  P” 
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with  respect  to  the  ground  site.  If  the  relationship  in  Equation  5.7  holds  true,  the  satellite 
is  in  view  of  the  ground  site.  Note,  is  the  Zenith  component  of  Psez  and  is  the 
minimum  elevation  angle  required  for  line  of  sight  contact  from  the  ground  site. 


6™  =  sin-^ 


I  piz(0  \ 

\  \psez  (t)  I  / 


>  C 


(5.7) 


Each  pass  k  over  the  ground  site  between  to  and  tmax  has  an  entry  time  and  a 
corresponding  exit  time  defining  the  line-of-sight  contact  of  the  target  with  the  ground 
site.  Given  a  specific  choice  of  satellite  m  and  pass  k,  the  chaser  is  required  to  enter 
the  cooperative  inspection  segment  at  The  cooperative  inspection  has  a  duration  of 
Center  ~  ^Ixit  seconds  and  the  chaser  is  permitted  to  initiate  its  transfer  to  the  final  mission 
orbit  sometime  after 

5.5.2  Cooperative  Inspection  Segment 

The  RSW  frame  is  centered  at  the  target  with  the  primary  axis  aligned  with 
A  second  (s  j  axis  is  normal  to  R  and  points  in  the  direction  of  the  inertial  velocity  vector 
of  the  target.  The  5 -axis  is  coincident  with  the  target’s  velocity  vector  if  the  target  if 
the  target’s  orbit  is  circular.  The  third  (zj  axis  points  in  the  orbit  normal  direction.  The 
coordinates  of  PuK^t)  are  converted  into  the  RSW  frame  according  to  Equation  5.8.  The 
rotation  angles  are  the  target’s  right  ascension  of  the  ascending  node,  (fl™),  inclination, 
(/"*),  and  argument  of  latitude,  (m™  (t)). 


PRswit)  =  R3  (m™  (0)  *  R1  (D  *  R3  *  puK  (t)  (5.8) 


The  angle  a(t),  measured  from  the  fundamental  (orbital)  plane  in  the  RSW  frame  to 
PRSw(t)  is  found  according  to  Equation  5.9,  where  PRsw(t)  is  the  unit  vector  corresponding 
to  PRSwit).  Similarly,  the  angle  >S(t),  measured  from  the  primary  axis  in  the  RSW  frame 
to  PRswif)  is  found  according  to  Equation  5.10.  The  superscripts,  R,  S ,  and  W  represent 
components  on  each  axis  in  the  RSW  frame. 

sin  a  (t)  =  p^swi^)  (5-9) 


100 


tan/3(0  = 


Prsw 

Prsw 


(5.10) 


The  angles  a  (t)  and  (i  (t)  are  used  to  define  the  eylinder  frame,  whieh  is  eentered  at 
the  target  and  oriented  such  that  its  primary  axis  is  aligned  with  Prsw  (0-  Any  vector  in  the 
cylinder  frame,  rcrt  (t),  can  be  converted  to  a  vector  in  the  RSW  frame,  r^swit),  according 
to  Equation  5.11. 


rRswit)  =  R3  i-fi  (t))  *  R2  (a  (t))  *  rcrt  (t)  (5.11) 


The  chaser’s  position  during  the  cooperative  inspection  segment  is  constrained  such 
that  it  must  be  on  the  primary  axis  of  the  cylinder  coordinate  frame  (CYL)  frame  at 
and  and  inside  the  cylinder  at  all  times  in  between.  The  cylinder  is  defined  in  the  CYL 
frame  such  that  one  base  is  at  and  the  other  is  at  ^  length  equal  to  miiius 

x'^yl-  "The  variables  Xcyl  ^cyl  (^Ly)  define  the  chaser’s  position  vectors  in  the 

CYL  frame  at  the  beginning  and  end  of  the  cooperative  inspection  segment,  respectively. 
The  corresponding  vectors  in  the  CYL  frame  are  shown  in  Equation  5.12. 


II 

^CYL  {tenter) 

0 

II 

.^1 

■^CYL  {t^exit) 

0 

0 

0 

The  vectors  shown  in  Equation  5.12  are  rotated  into  vectors  in  the  RSW  frame,  {tenter) 
and  using  Equation  5.11.  [46]  describes  a  method  to  find  the  entry  and  exit 

velocities  in  the  RSW  frame,  Vrsw{^ enter)  VRsw{^xit)^  respectively,  given  two  position 

vectors  and  the  time  of  flight  between  them.  In  this  case,  the  chaser’s  initial  and  final 
relative  position  vectors  are  Pjiswi^nter)  ^’^d  Pj^swi^lxit)^  respectively.  The  time  of  flight 
is  tenter  ~  t^^it  scconds.  The  relative  position  and  velocity  vectors  at  are  converted  to 
inertial  coordinates  using  Equations  5.13  and  5.14.  The  inertial  state  of  the  chaser  at  is 
found  in  the  same  way.  The  inertial  position  and  velocity  vectors  are  used  to  determine  the 
cost  of  the  first  and  second  impulsive  maneuvers.  Eor  the  duration  of  this  paper,  a  minus 
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superscript  (-)  denotes  a  state  just  prior  to  an  impulsive  maneuver  while  a  plus  superscript 
(+)  denotes  a  state  just  after  an  impulsive  maneuver.  Note  that  all  impulses  are  assumed 
instantaneous,  which  implies  the  position  vectors  just  prior  to  and  just  after  an  impulse  are 
the  same. 

'•;«  (C„)  =  Ki  (-fi”)  •  (-n  .  R3  (-«"  (4„))  .  (4,„)  (5.13) 

((1  (5.14) 

5.5.3  Impulsive  Transfer  to  Target 

The  chaser’s  initial  circular  orbit  is  defined  by  its  semi-major  axis  inclination  f, 
and  right  ascension  of  the  ascending  node  The  chaser  initiates  its  first  impulsive  transfer 
at  a  specified  argument  of  latitude  (ti)  where  t\  is  the  time  of  maneuver  initiation.  The 
position  and  velocity  vectors,  j  and  j,  respectively,  can  be  determined  using 

the  chaser’s  orbital  elements  at  t\. 

The  chaser  must  arrive  in  relative  motion  with  the  target  at  time  with  the  inertial 
position  specified  by  r^jj^  {fente)j-  The  time  of  flight  to  complete  the  maneuver  is  t2  seconds, 
which  implies  maneuver  initiation  occurs  at  ti  =  -  t2  seconds.  Connecting  two 

position  vectors  in  a  specified  time  is  the  well-known  Lambert’s  problem,  the  solution 
of  which  yields  the  chaser’s  departure  and  arrival  velocities  on  the  transfer  orbit  v j 
and  respectively.  This  research  utilized  a  Lambert  targeting  algorithm  provided 

by  [41].  The  first  and  second  maneuvers  have  costs  according  to  Equations  5.15  and  5.16. 

^V\  =  \v]jK{t\)  —  v]jK{ti)\  (5.15) 

AV2  =  I  (5-16) 

The  path  of  the  chaser  is  constrained  for  t\  <  t  <  tg„ygg  according  to  Equation  5.17, 
where  ^  (t)  is  the  elevation  angle  of  the  chaser  with  respect  to  the  ground  site  at  any  time 
and  is  the  maximum  allowable  elevation  angle  of  the  chaser  with  respect  to  the  site. 

(5.17) 
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5.5.4  Impulsive  Transfer  to  GEO  Segment 

The  chaser  coasts  for  seconds  after  which  defines  the  inertial  state  of  the  chaser 
at  the  instant  prior  to  the  third  impulsive  burn,  j  and  +  ^3  )•  The  coast 

is  restricted  such  that  the  chaser  may  not  come  within  50  meters  of  the  target.  The  desired 
final  position  of  the  chaser  is  defined  by  its  true  longitude  at  epoch  in  the  geostationary 
orbit,  lGEo[tf),  which  corresponds  to  inertial  position  and  velocity  vectors,  and 

respectively.  The  chaser  travels  from  j  to  (t/)  in  ^4  seconds, 

which  lends  itself  to  a  Lambert  targeting  solution.  The  initial  and  final  velocities  on  the 
transfer  orbit,  j  and  respectively,  provide  the  final  elements  needed 

to  compute  the  cost  corresponding  to  the  third  and  fourth  maneuvers,  as  shown  in  Equations 
5.18  and  5.19. 

AV,  =  +  +  (5.18) 

AV4  =  IV;,,-  (tjlj  -  v'jjf'  (ty  j  I  (5.19) 

The  path  of  the  chaser  is  constrained  for  <  t  <  tf  according  to  Equation  5.17. 

5.5.5  GTMEI  as  a  Hybrid  Optimal  Control  Problem 

The  GTMEI  problem  is  an  HOC  problem  with  two  categorical  variables  m  and 
k.  The  choice  of  a  specific  target  and  pass  combination  defines  the  times  of  the 
chaser’s  cooperative  inspection  segment  with  the  target.  The  definition  of  the  target-pass 
combination  specifies  the  bounds  required  to  optimize  the  seven  continuous  variables: 
Ucih),  t2,  xcYL{tenter)^  -^CYL  {tenter)^  L,  lGEo{tf),  and  L.  Eigurc  5.1  dcpicts  the  four  phases 
of  the  GTMEI  problem  and  Equation  5.20  defines  the  optimization  formulation.  The  target 
with  the  largest  number  of  passes  over  the  ground  site  from  to  to  tmax  sets  the  upper  bound 
K  on  the  categorical  pass  variable.  Any  target  m  which  has  L  <  K  passes  over  the  ground 
site  for  t  <  t^ax  is  assigned  an  infinite  cost  for  k  >  L.  Additionally,  the  value  of  k  specifies 
the  upper  bounds  on  the  inner- loop  problem  variables  t2  and 
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(a)  Cooperative  inspection  entry  and  exit  conditions  (b)  Impulsive  transfer  to  target 


(c)  Cooperative  inspection  in  RSW  frame  (d)  Impulsive  transfer  to  geostationary  orbit 

Figure  5.1:  Segments  of  the  GTMEI  problem 


minimize  J  (jc)  =  AVi  +  Ay2  +  ^1/3  +  AV4  km/s 
where  x  =  [m,  k,  (h) ,  ti,  xcyl  ^  ^cyl  ,  h,  Igeo  (tf) ,  U 
subject  to: 

\  <  m  <  M 
\  <k<K 
0  <if  (ti)  <  2n 


^exit  ^ 


1  <  t2  < 


enter 
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(a  Iv-  ( fk  \  ^  ^max 
^CYL  —  ^CYL  y enter)  ’  ^CYL  yexit)  -  ^CYL 


0<t3<&-?LY 


(5.20) 


5.6  Analysis 

5.6.1  Three  Target  Problem 

The  three  target  GTMEI  problem  required  the  chaser  satellite  to  transfer  from  LEO 
to  geostationary  orbit  while  inspecting  one  of  three  coplanar  targets.  Two  of  these 
targets  were  in  LEO  while  the  third  target  was  in  mid-Earth  orbit  (MEO).  The  relatively 
small  number  of  targets  allowed  for  complete  enumeration  of  the  problem  space  and 
provided  an  opportunity  to  test  the  performance  of  different  bi-level  HOC  algorithms  with 
respect  to  cost,  computational  speed,  and  number  of  cost  function  evaluations  required  for 
convergence. 

The  chaser’s  cooperative  inspection  segment  with  the  target  must  be  in  conjunction 
with  a  ground  site  defined  by  ^  =  45°  and  A  =  0°.  Eurther,  the  cooperative  inspection 
lasts  for  the  duration  of  the  target’s  horizon  to  horizon  contact  with  the  ground  site.  In 
other  words,  is  set  equal  to  zero.  Einally,  the  chaser’s  elevation  angle  with  respect  to 
the  ground  site  was  defined  to  be  equal  to  one  degree.  The  cylinder  bases  and 

are  set  at  one  and  three  km,  respectively,  t^ax  and  are  set  equal  to  36  and  16 
hours,  respectively.  The  value  of  t^ax  determines  the  number  of  passes  for  each  of  the  three 
potential  targets.  The  initial  conditions  of  the  chaser  and  targets  are  shown  in  Table  5.1 
along  with  the  number  of  feasible  passes  over  the  ground  site  in  the  given  scenario  time.  It 
should  be  noted  that  Target  1  is  in  line  of  sight  with  the  ground  site  at  to,  making  that  pass 
an  infeasible  choice  for  the  cooperative  inspection. 

The  start  times  and  duration  of  each  targets’  passes  over  the  ground  site  can  be  seen 
in  Eigure  5.2.  Note  that  all  orbits  are  circular  and  share  the  same  right  ascension  of  the 
ascending  node.  Additionally,  the  chaser’s  initial  orbit  is  defined,  but  its  initial  position  on 
that  orbit  is  a  function  of  the  optimization  variable,  (E). 

Eor  comparison  purposes,  consider  a  two-bum  combined  plane-change  transfer  from 
the  chaser’s  initial  orbit  to  geostationary  orbit  without  the  requirement  of  an  en-route 
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Table  5.1:  Initial  conditions  of  the  chaser  and  targets 


a  {km) 

/(°) 

M(to)r) 

#  passes 

Chaser 

6578.14 

55 

- 

- 

Target  1 

26,561.76 

55 

0 

2 

Target  2 

7378.14 

55 

0 

14 

Target  3 

6878.14 

55 

0 

14 

Time  (sec)  ,^4 

^  X  10 

Figure  5.2:  Target  pass  times  for  the  three  target  GTMEI 

inspection.  The  optimal  solution  for  such  a  transfer  can  be  found  according  to  simple 
two  body  orbital  mechanics.  It  requires  a  plane  change  of  2.86°  at  the  first  burn  and  the 
associated  cost  is  4.93944  km/s.  For  ease  of  comparison,  all  further  costs  are  normalized 
by  this  value. 

5.6.1. 1  Three  Target  Enumeration 

The  relatively  small  number  of  targets  were  chosen  because  they  allowed  for  complete 
enumeration  of  the  categorical  variable  space  and  provided  an  opportunity  to  evaluate  the 
performance  of  various  bi-level  algorithms.  Complete  enumeration  was  accomplished  by 
using  a  PSO  to  optimize  the  continuous  variables  for  each  target-pass  combination.  The 
PSO  defined  in  Table  5.2  is  based  on  algorithms  developed  in  [25,  55,  81,  84,  93].  The 
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PSO  optimized  each  target-pass  combination  20  times.  There  were  30  possible  target-pass 
combinations,  resulting  in  a  total  of  600  optimizations.  The  angular  variables,  (o)  and 
Igeo,  were  encoded  to  preserve  accuracy  to  the  nearest  hundredth  of  a  radian.  Similarly,  the 
relative  position  variables  preserved  accuracy  to  one  meter.  The  time  variables  preserved 
accuracy  to  the  nearest  second  in  order  to  facilitate  faster  evaluation  of  the  elevation 
constraint  on  the  chaser  spacecraft. 


Table  5.2:  Inner- loop  PSO  settings 


Swarm  Size 

300 

Max  Iterations 

500 

Cognitive  Parameter 

2.09 

Social  Parameter 

2.09 

Constriction  Eactor 

0.656295 

Tolerance 

le-6  km/s 

The  ten  lowest  cost  solutions  found  using  complete  enumeration  of  the  solution  space 
are  shown  in  Table  5.3.  Note  that  all  ten  require  approximately  2%  more  AT  than  the 
optimal  LEO-GEO  transfer  without  en-route  inspection.  Additionally,  all  ten  require  the 
chaser  to  inspect  during  one  of  Target  three’s  passes  over  the  ground  site.  In  fact,  the  top 
137  solutions  found  during  enumeration  all  required  the  chaser  to  inspect  one  of  Target 
three’s  passes.  The  lowest  cost  solutions  found  for  Targets  one  and  two  were  /  =  1.34875 
and  J  =  1.04267,  respectively.  These  ranked  203  and  138,  respectively,  of  all  solutions 
found  during  enumeration.  Solving  the  inner  loop  problem  required  an  average  of  1 17,600 
cost  function  evaluations  for  each  target-pass  combination.  This  implies  that  it  would  take 
approximately  3.52  million  cost  function  evaluations  to  generate  a  single  solution  for  each 
target-pass  combination. 
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Table  5.3:  Best  three  target  costs  found  by  enumeration 


Rank 

Satellite 

Pass 

J 

1 

3 

7 

1.01730 

2 

3 

7 

1.01753 

3 

3 

14 

1.01754 

4 

3 

14 

1.01757 

5 

3 

14 

1.01773 

6 

3 

7 

1.01783 

7 

3 

14 

1.01785 

8 

3 

7 

1.01786 

9 

3 

7 

1.01790 

10 

3 

11 

1.01790 

Enumeration  of  the  categorical  variable  space  provided  further  insight  into  the  solution 
space  of  the  three  target  GTMEI.  Eirst,  it  is  important  to  note  that  several  target- 
pass  combinations  yielded  no  feasible  solutions  after  20  PSO  runs,  while  no  target- 
pass  combination  yielded  both  feasible  and  infeasible  solutions.  Eigure  5.3  depicts  the 
topography  of  the  categorical  variable  space  where  a  normalized  cost  of  2  indicates 
an  infeasible  target-pass  combination.  Note  there  are  only  13  feasible  target-pass 
combinations  for  this  example. 

The  performance  of  the  PSO  with  respect  to  the  feasible  target-pass  combinations 
is  also  insightful.  Each  feasible  target-pass  combination  yielded  several  locally-optimal 
solutions,  which  is  consistent  with  the  stochastic  nature  of  the  PSO.  The  vast  majority 
of  feasible  solutions  yielded  costs  that  were  competitive  with  the  best  solution  found. 
Specifically,  half  of  the  feasible  solutions  were  within  one  percent  of  the  best  solution 
found,  while  three  quarters  of  the  feasible  solutions  were  within  ten  percent  of  the  lowest 
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Figure  5.3:  Characterization  of  three  target  categorical  variable  space 

cost  solution.  Further,  no  feasible  target-pass  combination  took  more  than  26  infeasible 
iterations  to  generate  a  feasible  solution,  implying  infeasible  target-pass  combinations  can 
be  identified  without  requiring  the  maximum  number  of  inner- loop  iterations. 

5.6.1.2  Three  Target  Hybrid  Optimization 
The  results  from  complete  enumeration  of  the  three  target  problem  led  to  the 
implementation  of  four  bi-level  HOC  algorithms.  Two  of  the  bi-level  algorithms  employed 
an  outer-loop  PSO,  while  the  other  two  employed  an  outer-loop  GA.  Both  types  of  outer- 
loop  optimizers  are  defined  in  Table  5.4.  Each  outer- loop  optimizer  employed  a  repository 
which  prevents  additional  inner-loop  optimization  for  a  previously  evaluated  target-pass 
combination.  Once  the  mth  target’s  kth  pass  has  been  optimized  by  the  inner-loop  PSO, 
the  inner-loop  variables  and  cost  are  stored  in  the  repository  location  corresponding  to  the 
specific  combination  of  m  and  k.  During  subsequent  outer-loop  iterations,  any  previously- 
evaluated  target-pass  combination  was  assigned  the  appropriate  inner-loop  variables  and 
cost  stored  in  the  repository.  This  approach  was  used  previously  in  [88]  and  is  appropriate 
to  this  problem  because  the  locally  optimal  solutions  identified  through  enumeration  are 
competitive  with  the  best  cost  found. 
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Table  5.4:  Outer- loop  optimization  routines 


PSO 

GA 

Swarm  Size 

15 

Population  Size 

15 

Iterations 

10 

Generations 

9 

Cognitive  Parameter 

2.09 

Selection  Eunction 

Binary  tournament 

Social  Parameter 

2.09 

Crossover  Eunction 

Integer 

Constriction  Eactor 

0.656295 

Elite  members 

I 

Crossover  Rate 

80% 

Additionally,  two  types  of  inner- loop  optimizers  were  employed  as  part  of  the  bi-level 
algorithms.  The  first  inner-loop  optimizer  was  a  PSO  identical  to  the  one  defined  in  Table 
5.2.  The  second  inner-loop  optimizer  employed  an  identical  PSO  as  the  first,  but  assigned 
an  infeasible  cost  to  any  target-pass  combination  which  did  not  generate  a  feasible  solution 
after  the  first  50  inner-loop  iterations.  This  was  designed  to  prevent  superfluous  inner-loop 
iterations  for  target-pass  combinations  that  were  likely  to  produce  infeasible  results. 

Each  outer-loop  optimizer  was  paired  with  each  inner- loop  optimizer,  resulting  in  four 
bi-level  HOC  algorithms  identified  as  follows:  genetic  algorithm  outer-loop  with  inner- 
loop  particle  swarm  (GP),  genetic  algorithm  outer- loop  with  inner- loop  particle  swarm 
employing  infeasible  cutoff  (GPi),  particle  swarm  outer-loop  with  inner-loop  particle 
swarm  (PP),  particle  swarm  outer- loop  with  inner- loop  particle  swarm  employing  infeasible 
cutoff  (PPi).  Each  bi-level  routine  was  used  to  solve  the  three  target  problem  30  times. 
The  inner-loop  optimizations  were  parallelized  on  an  Intel  Xeon  E5-2667  processor.  The 
number  of  outer-loop  iterations/generations  were  fixed  to  allow  for  more  meaningful 
performance  comparisons  between  the  GA  and  PSO  outer- loop  solvers.  The  PPi  algorithm 
converged  to  the  lowest  cost  solution  found  by  all  algorithms.  The  associated  cost  was 
/  =  1.01726,  and  is  hereafter  referred  to  as  the  minimum  for  the  three  target  problem. 
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The  variable  values  of  the  minimum  solution  are  shown  in  Table  5.5  along  with  the 
best  solutions  generated  by  the  other  bi-level  algorithms,  all  of  which  were  within  two 
hundredths  of  one  percent  of  the  minimum. 


Table  5.5:  Lowest  cost  solution  for  three  target  problem  found  by  each  bi-level  algorithm 


m/k 

(0) 

h 

yCnter 

■^CYL 

y.exit 

■^CYL 

h 

Igeo 

k 

/ 

pp 

3/7 

5.26 

2893 

2.247 

1.000 

46060 

0 

19073 

1.01747 

GP 

3/7 

5.29 

2866 

1.006 

1.163 

547 

0 

19153 

1.01730 

PPi 

3/14 

5.19 

2845 

1.155 

1.276 

45955 

0 

19151 

1.01726 

GPi 

3/7 

5.33 

2831 

1.000 

1.297 

546 

0 

19164 

1.01730 

The  chaser’s  path  for  the  duration  of  the  maneuver  sequence  corresponding  to  the 
minimum  solution  is  shown  in  Figure  5.4.  Figure  5.4(a)  illustrates  the  chaser’s  maneuver 
from  its  initial  orbit  to  the  cooperative  inspection  segment,  Figure  5.4(b)  shows  the  chaser’s 
path  in  the  rotating  cylinder  frame  during  the  cooperative  inspection,  and  Figure  5.4(c) 
shows  the  chaser’s  path  from  the  relative  motion  phase  to  GEO. 

The  performance  of  each  algorithm  with  respect  to  the  metrics  are  shown  in  Table 
5.6.  The  PPi  provided  the  most  consistent  cost  performance  and  the  greatest  computational 
benefit  to  complete  enumeration.  Additionally,  the  PPi  required  an  average  of  607, 000 
cost  function  evaluations,  which  are  one  fifth  as  many  as  would  be  required  to  enumerate 
the  problem  space.  The  worst  solution  found  by  any  algorithm  had  a  normalized  cost  of 
/  =  1.01919,  which  was  within  0.2%  of  the  minimum. 

Figure  5.5  shows  the  performance  of  each  bi-level  algorithm  with  respect  to  cost  and 
the  number  of  cost  function  evaluations  required  for  convergence,  with  the  best  results 
for  each  category  highlighted  in  bold  text.  Figure  5.5(a)  shows  the  performance  of  each 
bi-level  algorithm  with  respect  to  the  minimum  cost  found  for  the  three  target  problem. 
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(a)  Chaser  transfer  orbit  to  inspection  in  the  inertial  (b)  Chaser  path  in  the  cylinder  frame  during  inspec- 
frame  tion 


(c)  Chaser  transfer  orbit  to  geostationary  orbit  after 
inspection  in  the  inertial  frame 

Figure  5.4:  Path  of  chaser  corresponding  to  the  optimal  three  target  GTMEI 

/  =  1.01726.  Figure  5.5(b)  shows  the  number  of  cost  functions  evaluations  required  for 
each  hybrid  algorithm  to  converge  to  a  solution.  Note  that  all  bi-level  algorithms  require 
fewer  cost  function  evaluations  than  what  would  be  required  for  complete  enumeration. 

All  bi-level  algorithms  provided  similar  cost  performance  with  respect  to  the  minimum 
solutions  found.  The  PPi  and  GPi,  however,  generate  these  solutions  with  fewer 
cost  function  evaluations  than  were  required  using  the  other  methods.  Further,  the 


112 


Table  5.6:  Bi-level  algorithm  performanee  eomparison 


Metrie 

pp 

CP 

PPi 

CPi 

J min 

1.01747 

1.01730 

1.01726 

1.01730 

J max 

1.01881 

1.01903 

1.01838 

1.01919 

Cost 

J mean 

1.01797 

1.01799 

1.01784 

1.01798 

o-j 

0.00031 

0.00043 

0.00031 

0.00038 

fmin 

0.677 

1.730 

0.277 

0.624 

fmax 

2.329 

3.351 

0.979 

1.308 

Millions  of  Cost  Funetion  Evaluations 

fmean 

1.512 

2.744 

0.607 

0.942 

0.459 

0.358 

0.150 

0.142 

(a)  Cost  performance  as  percentages  of  the  minimum  (b)  Cost  function  evaluations  required  for  conver¬ 
gence 

Figure  5.5:  Bi- level  algorithm  performanee  data  for  three  target  problem 


eomputational  benefit  of  the  GPi  and  PPi  are  expeeted  to  inerease  as  the  number  of  target- 
pass  eombinations  inerease. 
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5.6.2  Fifteen  Target  Problem 

The  results  of  the  three  target  problem  led  to  implementing  the  PPi  algorithm  to 
optimize  a  larger,  fifteen  target  problem.  The  outer-loop  swarm  size  was  inereased 
to  20  partieles  to  aeeount  for  the  larger  eategorieal  variable  spaee.  Additionally,  the 
maximum  number  of  iterations  was  inereased  to  50  and  an  additional  stopping  eriteria 
was  added  sueh  that  the  optimization  terminated  if  the  objeetive  value  didn’t  ehange  for  ten 
eonseeutive  iterations.  The  inner-loop  parameters  remain  identieal  to  those  shown  in  Table 
5.2.  The  initial  ehaser  orbit,  ground  site,  elevation  eonstraints  and  limits  on  all  non-pass 
dependent  variables  were  identieal  to  those  defined  in  the  three  target  problem.  Eaeh  target 
satellite  began  in  a  eireular  orbit  with  orbital  elements  uniformly  randomized  on  intervals 
of  [6878  7378]  km  for  semi-major  axis,  [28.5°  55°]  for  inelination,  [-5°  -  5°]  for  right 
ascension  of  the  ascending  node,  and  [0°  360°]  for  initial  argument  of  latitude.  The  targets’ 
defining  orbital  elements  are  shown  in  Table  5.7  along  with  the  number  of  passes  over  the 
ground  site.  Figure  5.6.2  shows  the  line  of  s  contact  times  for  each  of  the  fifteen  targets  with 
the  ground  station  for  the  time  interval  from  to  to  t^ax-  The  PPi  was  used  to  solve  the  fifteen 
target  problem  30  times  on  the  same  workstation  utilized  for  the  three  target  problem. 
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Figure  5.6:  Target  pass  times  for  the  fifteen  target  GTMFI 
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Table  5.7:  Target  satellites’  initial  conditions 


a  (km) 

iC) 

QC) 

uC) 

passes 

Target  1 

6931.33 

53.99 

2.75 

1.67 

14 

Target  2 

7286.65 

51.52 

359.00 

30.40 

14 

Target  3 

7007.94 

49.70 

4.11 

155.31 

14 

Target  4 

6968.92 

35.49 

356.36 

52.39 

11 

Target  5 

7312.65 

43.86 

356.45 

197.95 

12 

Target  6 

7304.52 

44.98 

0.13 

126.34 

12 

Target  7 

7078.90 

30.51 

356.23 

86.37 

9 

Target  8 

6969.95 

34.86 

355.50 

150.22 

10 

Target  9 

7329.36 

53.54 

359.89 

176.71 

14 

Target  10 

7046.86 

52.35 

356.11 

132.93 

14 

Target  1 1 

7268.13 

38.83 

359.04 

87.01 

12 

Target  12 

6926.23 

32.00 

4.56 

339.14 

8 

Target  13 

7165.60 

30.08 

358.53 

84.52 

9 

Target  14 

7288.60 

28.91 

356.69 

15.49 

10 

Target  15 

7202.56 

47.89 

359.51 

233.19 

14 

The  PPi  algorithm  converged  to  solutions  for  five  different  target-pass  combinations 
of  a  possible  177,  resulting  in  22  distinct  solutions  in  the  course  of  the  30  runs.  The 
best  and  worst  solutions  for  each  target-pass  combination  are  shown  in  Table  5.8,  along 
with  their  respective  rank  out  of  the  30  runs.  Once  again,  the  GTMEI  can  be  achieved 
for  only  a  fraction  more  AT  than  what  is  required  to  complete  a  transfer  from  the  initial 
orbit  to  geostationary  orbit.  Additionally,  Figure  5.6.2  shows  the  lowest  normalized  cost 
found  during  the  course  of  this  research  for  each  target-pass  combination.  All  infeasible 
combinations  were  assigned  /  =  2. 
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Table  5.8:  Best/worst  solution  for  each  target-pass  combination  converged  upon  by  the  PPi 


Rank 

m/k 

(ti) 

h 

y.enter 

•^CYL 

y.exit 

■^CYL 

h 

Igeo 

k 

/ 

1 

9/1 

3.10 

3236 

2.856 

1.940 

1885 

6.28 

19173 

1.04825 

30 

9/1 

4.07 

2340 

1.956 

2.774 

1840 

0.00 

19660 

1.07353 

10 

9/9 

3.10 

3249 

3.000 

3.000 

1819 

6.28 

19174 

1.04892 

15 

9/9 

3.10 

3249 

3.000 

3.000 

1774 

0.00 

19660 

1.04901 

16 

9/8 

3.14 

3332 

1.138 

1.025 

2293 

6.28 

19155 

1.05417 

19 

9/8 

3.14 

3332 

1.000 

3.000 

2290 

6.28 

19221 

1.05467 

18 

1/14 

5.00 

3117 

3.000 

3.000 

480 

0.05 

19551 

1.05450 

24 

1/14 

5.00 

3117 

3.000 

3.000 

32294 

3.18 

18097 

1.06009 

20 

1/7 

4.99 

3126 

1.385 

3.000 

26399 

3.19 

19306 

1.05470 

27 

1/7 

5.00 

3119 

2.094 

1.841 

37916 

3.19 

19214 

1.05504 

1  2  3  4  5  6  7  8  9  10  11  12  13  14 

Pass 


Figure  5.7:  Characterization  of  fifteen  target  categorical  variable  space 

As  expected,  the  algorithm  converged  to  multiple  locally  optimal  solutions  for  each 
target-pass  combination.  The  best  and  worst  solutions  found  over  the  course  of  30  runs 
occurred  on  the  ninth  target’s  first  pass;  the  associated  costs  were  /  =  1.04825  and 
/  =  1.07353,  respectively,  resulting  in  a  difference  of  only  2.4%.  Figure  5.8(a)  shows  the 
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cost  performance  of  the  bi-level  PPi,  with  respect  to  the  minimum  cost  found.  Similarly, 
Figure  5.8(b)  shows  the  number  of  eost  funetion  evaluations  required  for  convergence. 


%  of  Global  Minimum  Millions  of  Cost  Function  Evaluations 


(a)  Solutions  as  percentages  of  the  minimum  (b)  Cost  function  evaluations  required  for  conver¬ 
gence 

Figure  5.8:  Fifteen  target  performanee  data 

As  expeeted,  the  bi-level  PPi  algorithm  provides  an  even  greater  benefit  with  respeet 
to  eost  funetion  evaluations  required  for  eonvergenee.  The  PPi  required  an  average  of 
2.41  million  cost  function  evaluations  to  converge  to  a  solution  for  the  fifteen  target 
problem.  Recall  that  enumeration  of  the  three  target  problem  required  117,600  cost 
functions  evaluations  for  eaeh  target  pass  eombination.  As  a  result,  enumerating  the  fifteen 
target  problem  would  require  approximately  20.82  million  eost  funetion  evaluations.  This 
implies  that  the  PPi  can  generate  a  solution  nearly  nine  times  faster  than  enumeration. 

5.7  Conclusions 

This  work  defined  the  geostationary  transfer  maneuver  with  en-route  inspeetion 
problem.  This  problem  is  designed  to  optimize  a  transfer  for  a  spaee  situational  awareness 
platform  from  low  Earth  orbit  to  geostationary  orbit,  during  whieh  the  platform  performs  a 
close-proximity  inspeetion  with  one  of  several  uneharaeterized  objeets  in  eooperation  with 
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a  designated  ground  site.  The  eooperative  inspeetion  requires  the  maneuvering  satellite  to 
stay  within  a  eylindrieal  volume  defined  by  the  target  and  ground  site  for  the  duration  of 
the  objeet’s  pass  over  the  ground-based  observer.  The  eylindrieal  volume  is  oriented  sueh 
that  the  long  axis  of  the  eylinder  is  aligned  with  the  veetor  eonneeting  the  ground  site  to 
the  objeet. 

The  geostationary  transfer  maneuver  with  en-route  inspeetion  problem  is  formulated 
as  a  hybrid  optimal  eontrol  problem  and  solved  using  several  bi-level  algorithms.  The 
outer-loop  algorithm  optimized  the  eategorieal  variables:  the  target  and  pass  eombination 
to  perform  the  en-route  inspeetion.  The  inner-loop  optimized  the  eontinuous  variables 
assoeiated  with  designated  target-pass  eombinations.  The  bi- level  algorithms  employed 
either  a  genetie  algorithm  or  a  partiele  swarm  optimization  algorithms  as  the  outer-loop 
solver  and  employed  inner-loop  partiele  swarm  optimization  algorithms.  Two  types  of 
inner-loop  algorithms  were  employed:  the  first  was  a  partiele  swarm  optimization  algorithm 
while  the  seeond  was  a  partiele  swarm  optimization  algorithm  that  assigned  an  infinite 
eost  to  any  target-pass  eombination  that  yielded  infeasible  results  after  a  finite  number  of 
inner-loop  iterations.  Eaeh  inner-loop  optimizer  was  paired  with  eaeh  outer-loop  algorithm, 
resulting  in  four  bi-level  optimizers.  A  three  target  geostationary  transfer  maneuver  with 
en-route  inspeetion  problem  was  used  to  evaluate  the  performanee  of  the  bi-level  variants 
in  eomparison  to  one  another  and  eomplete  enumeration  for  the  eategorieal  variable  spaee. 
The  results  of  the  three  target  problem  showed  that  all  variants  eonverged  to  near  optimal 
solutions.  The  results  further  led  to  the  implementation  of  a  bi-level  algorithm  whieh 
employed  an  outer-loop  partiele  swarm  and  inner-loop  partiele  swarm  with  infeasible 
eutoff,  whieh  eonverged  to  near  optimal  solutions  for  a  fifteen  target  problem.  Results 
for  the  two  example  problems  indieate  that  the  bi-level  algorithm  partiele  swarm  outer- 
loop  paired  with  partiele  swarm  inner-loop  with  infeasible  eutoff  provides  additional 
eomputational  efheieney  as  the  size  of  the  eategorieal  spaee  inereases  while  still  generating 
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near  optimal  results.  The  three  and  fifteen  target  example  problems  showed  that  the 
en-route  inspection  can  be  accomplished  with  the  addition  of  a  fraction  of  the  delta- 
velocity  required  for  a  transfer  from  low  Earth  orbit  to  geostationary  orbit.  As  a  result, 
the  geostationary  transfer  maneuver  with  en-route  inspection  problem  can  be  considered 
as  a  potential  method  to  enhance  space-based  space  situational  awareness  at  low  and 
geostationary  orbits. 
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VI.  Conclusions  and  Contributions 


6.1  Impulsive  Responsive  Theater  Maneuvers 

The  first  contribution  of  this  research  was  the  design  and  optimization  of  impulsive 
responsive  theater  maneuvers  (RTMs)  that  enable  resiliency  by  altering  a  spacecraft’s 
arrival  conditions  over  a  potentially  hazardous  geographic  region.  Several  particle  swarm 
optimization  (PSO)  algorithms  and  a  genetic  algorithm  (GA)  were  shown  to  generate 
optimal  solutions  for  a  single  pass  RTM  scenario.  These  results  demonstrated  the  utility 
of  evolutionary  algorithms  (EAs)  in  the  optimization  of  impulsive  resiliency  maneuvers. 
Further,  the  performance  of  each  algorithm  was  evaluated  based  on  convergence  percentage 
to  the  global  minimum  as  well  as  computational  speed.  The  performance  characterization 
led  to  the  development  of  an  optimization  strategy  utilizing  a  global  version  of  the  PSO 
that  consistently  generated  optimal  solutions  in  only  minutes  of  computational  time. 

This  optimization  strategy  was  applied  to  single,  double,  and  triple  pass  RTMs  with 
varying  initial  conditions  and  maneuver  constraints  and  was  shown  to  consistently  produce 
optimal  maneuvers  for  each.  The  robustness  of  the  technique  with  respect  to  impulsive 
RTMs  implies  that  EAs  have  the  potential  to  enable  the  autonomous  optimization  of 
impulsive  resiliency  maneuvers.  This  potential  results  from  the  consistent  convergence 
performance  of  the  PSO  and  the  fact  that  it  does  not  require  an  initial  guess  to  generate  a 
solution.  Further,  the  impulsive  RTM  definition  and  solution  algorithm  can  be  applied  to 
more  complex  and  longer  scenarios. 

6.2  Continuous  Thrust  Responsive  Theater  Maneuvers 

The  second  major  contribution  of  this  research  was  the  extension  of  the  RTM  to 
include  continuous,  low-thrust  maneuvers,  which  was  accomplished  with  the  application  of 
a  two-stage  optimization  algorithm.  The  algorithm  leveraged  the  strengths  of  a  PSO  and  a 
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direct  orthogonal  collocation  (DOC)  method  with  a  nonlinear  programming  (NLP)  problem 
solver;  the  PSO  did  not  require  an  initial  guess  and  provided  a  broad  search  capability, 
while  DOC  provided  a  method  to  accurately  model  a  large  number  of  control  parameters 
impacting  the  system  dynamics. 

The  two-stage  optimization  routine  was  applied  to  single,  double,  and  triple  pass 
RTM  scenarios  with  varying  initial  conditions  and  maneuver  constraints  and  shown 
to  consistently  generate  solutions  satisfying  the  analytical  necessary  conditions  for  an 
optimal  control.  The  ability  of  the  two-stage  optimization  algorithm  to  provide  consistent 
convergence  performance  regardless  of  the  initial  conditions  and  maneuver  constraints 
indicate  its  potential  to  aid  in  the  autonomous  generation  of  low-thrust  resiliency 
maneuvers. 

The  low-thrust  RTM  research  also  demonstrated  that  resiliency  maneuvers  can  be 
accomplished  with  a  low-thrust  engine  in  less  than  one  orbit.  Thus,  mission  planners  have 
several  propulsion  options  at  their  disposal  when  designing  satellites  to  perform  resiliency 
maneuvers.  Additionally,  as  engine  technology  improves  the  low-thrust  version  of  the  RTM 
can  provide  provide  significant  propellant  mass  savings  in  comparison  to  the  impulsive 
version.  This  savings  could  be  used  to  extend  mission  life  by  adding  additional  fuel  or  to 
increase  the  payload  capacity  of  a  spacecraft  designed  for  resiliency. 

6.3  Geosynchronous  Transfer  Maneuvers  with  Cooperative  En- Route  Inspection 

The  final  contribution  of  this  research  was  the  development  of  a  technique  to 
generate  near-optimal  trajectories  for  a  new  type  of  maneuver,  called  geostationary 
transfer  maneuver  with  cooperative  en-route  inspection  (GTMEI).  GTMEIs  are  designed 
to  improve  space  situational  awareness  (SSA)  and  require  a  maneuvering  spacecraft  to 
transfer  from  low  Earth  orbit  (EEO)  to  geostationary  orbit  while  performing  an  en-route 
inspection  of  one  of  several  target  satellites  while  the  target  is  in  line-of-sight  contact  with 
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a  designated  ground  location.  They  are  a  class  of  hybrid  optimal  control  (HOC)  problems, 
which  consist  of  a  combination  of  categorical  and  continuous  variables. 

Four  separate  bi-level  HOC  algorithms  consisting  of  GA  and  PSO  algorithms  were 
shown  to  generate  optimal  and  near  optimal  solutions  to  a  simplified  three  target  GTMEI. 
A  bi-level  HOC  algorithm,  particle  swarm  outer-loop  with  inner-loop  particle  swarm 
employing  infeasible  cutoff  (PPi),  was  shown  to  provide  significant  computational  savings 
over  other  explored  bi-level  algorithms.  The  PPi  was  then  applied  to  a  larger  fifteen- 
target  GTMEI  problem  and  shown  to  provide  significant  computational  benefit  to  complete 
enumeration  of  the  solution  space. 

This  research  is  significant  because  it  shows  that  a  relatively  simple  algorithm  has 
the  capability  to  generate  near-optimal  solutions  to  complex  problems.  The  bi-level  HOC 
algorithms  developed  in  this  research  should  provide  even  greater  computational  benefit 
for  larger  GTMEI  scenarios.  Eurther,  the  consistent  performance  of  these  algorithms  in  the 
solution  of  GTMEIs  demonstrate  their  potential  to  enable  the  autonomous  generation  of 
to-be-developed  resiliency  maneuvers  requiring  HOC. 

6.4  Overall  Conclusion 

This  research  defined  a  new  set  of  maneuvers  to  enhance  spacecraft  resiliency  through 
avoidance  and  provided  several  options  for  mission  planners  in  their  design.  The  maneuvers 
included  both  impulsive  and  continuous  thrust  options  for  altering  a  spacecraft’s  arrival 
conditions  as  they  enter  a  potentially  hostile  geographic  region  on  the  earth.  These 
maneuvers,  each  of  which  require  only  meters  per  second  of  AT,  can  be  employed  by 
mission  planners  to  introduce  uncertainty  for  ground-based  tracking  systems.  As  a  result, 
these  maneuvers  provide  a  low-cost  option  for  the  enhancement  of  spacecraft  resiliency. 
The  methods  presented  in  this  dissertation  lay  the  groundwork  for  future  work  in  the 
autonomous  design  of  resiliency  maneuvers. 
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This  research  also  demonstrated  the  effectiveness  of  a  bi-level  ffOC  algorithm  in  the 
optimization  of  the  GTMEl  problem,  which  enhances  resiliency  by  introducing  uncertainty 
to  ground-based  tracking  algorithms.  Additionally,  the  bi-level  ffOC  algorithms  developed 
herein  generated  near-optimal  trajectories  at  much  faster  computational  speeds  than 
complete  enumeration  of  the  problem  space.  These  savings  are  expected  to  increase  as 
the  complexity  and  size  of  the  GTMEl  scenarios  increase. 

The  tools  and  techniques  developed  in  this  research  demonstrated  their  effectiveness 
in  producing  optimal  and  near  optimal  RTMs  and  GTMEls.  The  performance  of  these 
algorithms  provide  confidence  that  they  can  be  applied  to  more  complex  RTM  and  GTMEl 
scenarios.  More  importantly,  this  research  demonstrated  the  effectiveness  of  EAs  and 
metaheuristics  as  enablers  for  autonomous  resiliency  maneuver  generation  for  a  variety 
of  optimal  trajectory  problems  including  impulsive  and  continuous  thrust  trajectories  as 
well  as  hybrid  optimal  control  problems.  As  a  result,  these  methods  and  algorithms  can  be 
applied  to  future  resiliency  maneuvers  that  have  yet  to  be  developed  by  mission  planners. 

6.5  Assumptions  and  Limitations 

The  algorithms  developed  in  this  research  provide  a  foundation  for  the  autonomous 
optimization  of  responsive  resiliency  maneuvers.  There  are,  however,  several  simplifying 
assumptions  that  will  limit  their  utility  if  not  addressed.  Eirst,  no  consideration  was  given  to 
additional  spacecraft  constraints  such  as  power  and  duty  cycle  limitations  on  the  propulsion 
system  resulting  from  mission  requirements.  Such  considerations  add  constraints  to  these 
problems  and  could  limit  the  number,  duration,  or  frequency  of  resiliency  maneuvers. 

Other  critical  assumptions  made  throughout  this  research  were  those  leading  to  the 
two-body  dynamics  representing  all  spacecraft  motion.  Einearizing  the  equations  of  motion 
removes  the  need  to  perform  computationally  expensive  numerical  integration  inside  the 
EAs,  which  dramatically  improves  the  speed  of  the  algorithms,  ffigher  fidelity  models, 
which  would  be  required  to  perform  conjunction  analysis,  will  increase  the  computational 
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time  of  these  algorithms  to  the  point  at  which  a  spacecraft  may  no  longer  be  able  to 
maneuver  every  orbit. 

Conjunction  analysis  presents  a  further  limitation  to  autonomous  maneuver  gener¬ 
ation.  Specifically,  conjunction  analysis  is  historically  controlled  by  a  centralized  loca¬ 
tion  and  requires  significant  computational  resources.  Any  maneuver  generated  by  an  au¬ 
tonomous  algorithm  would  require  vetting  by  such  an  organization.  A  hypothetical  scenario 
requiring  resiliency  maneuvers  on  every  orbit  would  require  significant  resources  on  the 
part  of  the  vetting  organization,  greatly  reducing  the  autonomous  nature  of  the  maneuvers 
proposed  in  this  dissertation. 

6.6  Areas  for  Future  Work 

There  are  several  areas  in  which  this  research  can  be  continued  which  are  listed  below. 

1.  Quantify  RTM  effects  on  ground-based  tracking  performance. 

a.  Determine  how  long  it  takes  ground-based  tracking  systems  to  converge  to  an 
accurate  post-maneuver  orbit  fit. 

b.  Analyze  the  impact  of  maneuver  size  on  tracking  algorithm  performance. 

c.  Develop  a  maneuvering  strategy  to  maximize  the  impact  on  tracking  algorithm 
performance  while  minimizing  AV. 

2.  Introduce  additional  complexity  into  the  RTM  problem. 

a.  Quantify  the  impact  of  power  system  requirements  and  duty  cycle  on  the  RTM 
problem.  Determine  the  implications  of  RTMs  on  satellite  sub-system  design. 

b.  Develop  a  maneuvering  strategy  for  multiple  exclusion  zone  scenarios. 

3.  Apply  hybrid  optimal  control  algorithms  to  optimize  RTM  for  a  planned  system  with  a 
dual  impulsive  and  continuous-thrust  propellant  system. 
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4.  Quantify  GTMEI  effects  on  ground-based  tracking  algorithms. 

5.  Develop  and  optimize  RTMs  and  GTMEIs  for  multiple  ground  locations. 
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Appendix  A:  Derivation  of  Spherical  Equations  of  Motion 


Consider  the  spherieal  eoordinate  system  in  the  perifoeal  frame  shown  in  Figure  2.3, 
in  whieh  the  gravitational  foree  of  the  Earth  is  the  only  foree  aeting  on  a  spaeeeraft  with 
mass  m.  The  eoordinates  are  speeified  as  r  and  if/,  where  r  is  the  distanee  from  the  center 
of  the  coordinate  frame  and  if/  is  the  angle  measured  from  some  reference  axis. 

The  spacecraft  has  kinetic  energy  T  as  shown  in  Equation  A.l,  where  v  is  the  velocity 
vector  of  the  spacecraft. 

T  =  -m(v  •  v)  =  +  r^ij/^^  (A.l) 

Similarly,  the  spacecraft  has  potential  energy  V  shown  in  Equation  A. 2,  where  //  is  the 
gravitational  parameter  of  the  Earth. 


r 

As  a  result,  the  Eagrangian  can  be  written  as 

^  =  T  -  V  =  -mir^  +  r^ij/^\  +  -m. 

2  '  '  r 

The  resulting  momenta  are  expressed  as  shown  in  Equations  A. 4. 

p,  =  ^  =  mr 

pi  c/>  9  * 

P4>  =  nf;  =  V 

Equation  A. 4  can  be  rearranged  to  provide  expressions  for  r  and  tp. 


(A.2) 


(A.3) 


(A.4) 


r  =  qr  =  ^ 
If/  =  ^ 


(A.5) 


The  system  Hamiltonian  is  defined  as  =  2  Piqi  -  ^ ■  After  some  arithmetic,  this 
results  in  Equation  A. 6. 


\pl  \  p\  n 
=  -—  +  - — ^  -  -m 
2  m  2  mr^  r 


(A.6) 
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The  rate  of  change  of  the  momenta  can  be  expressed  as  shown  in  Equation  A.7. 


p  = 

^  _  _  <9^  _  A 

P'l'  -  'W  ~  ^ 


(A.7) 


Taking  the  time  derivative  of  Equation  A.4  and  substituting  the  results  into  Equation 
A.7  provides  expressions  for  f  and  ij/. 


r  -  rfi!  _  ii 

/  —  j 

r  n 

^ 


(A.8) 


Now  choose  four  states,  r,  if/,  Vr,  and  where  Vr,  and  Vij,  are  defined  by  Equation 


A.9. 


Vr  =  r 
=  rij/ 

The  time  rates  of  change  of  the  states  are  shown  in  Equation  A.  10. 


(A.9) 


r  =  Vr 

'■  (A.  10) 

Vr  =  r 

Vif,  =  ri}/  +  rij/ 

Substituting  the  expressions  for  f  and  ij/  from  Equation  A.8  into  Equation  A.  10 
provides  an  alternative  representation  of  the  equations  of  motion. 


r  =  Vr 


K 


r 


r 


(A.ll) 
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Appendix  B:  Equations  of  Motion  in  the  Local  Vertical,  Local  Horizontal  Frame 


The  local  vertical,  local  horizontal  coordinate  frame  (RSW)  frame  is  typically  used 
as  the  frame  of  reference  when  analyzing  the  motion  of  a  satellite,  called  the  chaser,  with 
respect  to  a  second  satellite,  called  the  target.  In  such  cases,  the  target  serves  as  the  origin 
of  the  RSW  frame  and  the  relative  position  and  velocity  vectors  of  the  chaser,  rRsw  and 
respectively,  are  given  by  Equation  B.l. 


(B.l) 


^Rsw  —  xR  +  yS  +  zW 
Vrsw  =  xR  +  yS+zW 

The  motion  of  the  chaser  relative  to  the  target  can  be  found  according  to  Newton’s 
second  law  and  the  universal  law  of  gravitation.  It  is  possible  to  derive  the  equations  of 
motion  shown  in  Equation  B.2  using  the  following  simplifying  assumptions 


1 .  the  target  and  chaser  are  in  nearly  circular  orbits 


2.  the  distance  between  the  target  and  chaser  is  much  smaller  than  the  semimajor  axis 
of  the  target  orbit 


These  equations  provide  analytical  expressions  to  determine  the  chaser’s  position  and 
velocity  relative  to  the  target  as  functions  of  time.  A  subscript  of  zero  designates  the 
chaser’s  relative  position  or  velocity  at  the  initial  time  to  and  the  variable  t  represents  the 
amount  of  time  that  has  passed  since  to-  The  mean  motion  of  the  target  is  n.  A  complete 
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derivation  of  these  equations  can  be  found  in  [36,  389-393]. 

x{t)  =  f  sin  {nt)  -  (Sxq  -h  cos  (nt)  +  {4xo 
y  (0  =  (6.ro  +  v)  ^  +  3  jo)  ^  +  (yo-^) 

z  (t)  =  Zo  cos  (nt)  +  -  sin  (nt) 

"  (B.2) 

X  (t)  =  xo  cos  (nt)  -I-  (3n.ro  +  2jo)  sin  (nt) 
y  (t)  =  (6nxo  +  4jo)  cos  (nt)  -  2xo  sin  (nt)  -  (6nxo  +  3  jo) 
z  (t)  =  -zon  sin  (nt)  -l-  zo  cos  (nt) 

An  equivalent  but  alternative  formulation  [46]  can  be  found  by  scaling  t  by  the  orbital 
period  of  the  target  satellite.  This  results  in  a  scaled  time  t  The  relative  position 

components  (x,  y,  z)  are  identical  to  their  counterparts  in  the  unsealed  frame.  The  relative 
velocity  components  (.r,  j,z),  however,  are  all  scaled  by  Ptgt.  This  transformation  leads  to 
the  equations  of  motion  shown  in  Equation  B.3.  A  derivation  can  be  found  in  [46]. 


x(t) 

y(t) 

z(t) 

x(t) 

y(0 

z(t) 


^  jo  sin  (Int)  -  {3xq  +  ^  yo  cos  (Int)  (4.ro  -t  ^yo) 

(6.ro  -t  3yo)  sin  (Int)  +  j^Xo  cos  (2nt)  -  (l2nxo  -i-  3yo)  ?  +  (jo  -  ^yo) 
Zo  cos  (2;rt)  -l-  ^zo  sin  (2nt) 

Xo  cos  (2nt)  +  (6nxo  +  2jo)  sin  (2nt) 

(l27rio  +  4 jo)  cos  (2nt)  -  2xo  sin  (2nt)  -  (l2;r.ro  -i-  3  jo) 

-27rzo  sin  (2nt)  -l-  zo  cos  (2nt) 


(B.3) 
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Appendix  C:  Design  of  Experiments  on  Particle  Swarm  Optimization  Parameters 


The  following  are  results  from  a  design  of  experiments  (DOE)  approaeh  to  determine 
the  ideal  PSO  parameters  to  optimize  single  pass  impulsive  RTM  problems.  The  goal 
was  to  determine  a  set  of  PSO  parameters  that  provided  eonsistent  eonvergenee  to  the 
global  minimum,  eliminated  all  solutions  not  at  least  loeally  optimal,  and  provided  fast 
eomputational  speed,  thus  enabling  autonomy. 

The  two  variable  single  pass  RTM  defined  in  Equation  4.7  of  Chapter  3  was  used 
as  the  test  ease  beeause  the  optimal  results  were  found  using  a  simple  parameter  seareh. 
Additionally,  the  problem  is  known  to  have  a  loeally  optimal  solution  only  slightly  larger 
than  globally  optimal  eost:  4.122  m/see  eompared  to  4.083. 

A  two  parameter  DOE  study  investigated  the  effeet  of  swarm  size  and  c  =  ci  =  C2  on 
the  performanee  of  the  PSO  in  the  solution  of  the  single  pass  RTM  defined  in  4.7. 

A  PSO  algorithm  utilizing  eaeh  set  of  bounds  defined  by  [107]  was  run  twenty  times. 
Eaeh  design  was  evaluated  aeeording  to  the  minimum,  maximum,  and  average  number  of 
iterations  required  for  eonvergenee.  Additionally,  eaeh  design  was  evaluated  aeeording  to 
eost  function  performance,  which  was  measured  in  convergence  percentage  to  the  global 
minimum,  local  minimum,  and  other  solutions. 

The  initial  bounds  on  each  variable  were  chosen  based  on  the  literature  and  are  defined 
in  Equation  C.l.  It  should  be  noted  that  the  PSO  algorithm  employed  utilized  a  constriction 
factor,  which  requires  Ci  +  C2  >  4. 


2  <  c  <  3.5 


(C.l) 


20  <  5  <  200 

The  design  space  and  performance  results  according  to  each  combination  of 
parameters  is  seen  in  Table  C.l.  The  top  three  performing  algorithms  with  respect  to 
percent  convergence  to  the  global  minimum  and  average  number  of  iterations  required 
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are  identified  by  *,  and  ***,  respectively.  The  worst  three  algorithms  with  respect  to 
percent  convergence  to  the  global  minimum  and  average  number  of  iterations  required  are 
identified  by  *,  **,  and  *  *  *,  respectively. 


Table  C.  1 :  Performance  data  for  initial  set  of  DOE  bounds 


s 

c 

min 

max 

avg 

global 

local 

other 

200 

2.47 

114 

1000 

538.80 

75*** 

25 

0 

65 

2.09 

111 

1000 

341.95 

80** 

20 

0 

99 

2.19 

68 

902 

232.95** 

85* 

15 

0 

133 

2.28 

78 

1000 

402.95 

70 

30 

0 

189 

3.13 

1000 

1000 

1000.00*** 

60 

40 

0 

76 

3.50 

539 

1000 

971.65** 

35 

35 

30 

54 

2.94 

150 

1000 

580.90 

50 

40 

10 

178 

2.84 

275 

1000 

810.55 

50 

30 

20 

no 

2.75 

150 

807 

524.90 

70 

30 

0 

20 

2.03 

30 

1000 

339.30 

15* 

30 

55 

155 

3.41 

1000 

1000 

1000.00*** 

30*** 

65 

05 

121 

3.31 

1000 

1000 

1000.00*** 

50 

45 

05 

88 

3.22 

464 

1000 

895.05** 

25** 

65 

10 

31 

2.38 

44 

273 

120.55* 

65 

35 

0 

166 

2.56 

133 

1000 

599.00 

70 

25 

5 

43 

2.66 

76 

1000 

247.95*** 

45 

55 

0 

The  results  from  the  initial  study  led  to  a  new  set  of  bounds  of  the  variables,  defined 
in  Equation  C.2.  The  results  are  shown  in  Table  C.2.  Notice  there  are  several  combinations 
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which  lead  to  solutions  that  are  not  at  least  locally  optimal. 


2.05  <  c  <  3 
30  <  s  <  150 


(C.2) 


Table  C.2:  Performance  data  for  second  set  of  DOE  bounds  on  two  parameter  study 


s 

c 

min 

Iterations 

max  avg 

Convergence  Percentage 

global  local  other 

150 

2.35 

143 

1000 

488.80 

75** 

25 

0 

60 

2.11 

81 

1000 

298.15 

70*** 

30 

0 

83 

2.17 

62 

739 

182.85* 

50 

50 

0 

105 

2.23 

96 

655 

242.60 

70*** 

30 

0 

143 

2.76 

204 

1000 

623.90*** 

30* 

65 

5 

68 

3.00 

270 

1000 

563.45 

35** 

65 

0 

53 

2.64 

123 

704 

319.10 

45 

55 

0 

135 

2.58 

113 

1000 

567.55 

55 

35 

10 

90 

2.53 

137 

1000 

319.15 

55 

45 

0 

30 

2.70 

58 

1000 

335.65 

45 

50 

5 

120 

2.94 

158 

1000 

880.70* 

65 

35 

0 

98 

2.88 

251 

1000 

651.10** 

45 

50 

5 

75 

2.82 

163 

1000 

487.70 

55 

45 

0 

38 

2.29 

44 

683 

183.10** 

55 

45 

0 

113 

2.05 

160 

702 

311.70 

00 

o 

20 

0 

128 

2.41 

95 

908 

313.80 

65 

35 

0 

45 

2.47 

62 

784 

214.20*** 

40*** 

60 

0 

The  results  led  to  a  new  set  of  bounds,  defined  in  Equation  C.3.  The  results  are  shown 
in  Table  C.3.  Notice  there  are  still  several  combinations  which  lead  to  solutions  that  are  not 
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at  least  locally  optimal. 

2.05  <  c  <  2.5 
30  <  s  <  120 


(C.3) 


Table  C.3:  Performance  data  for  third  set  of  DOE  bounds  on  two  parameter  study 


s 

c 

min 

max 

avg 

global 

local 

other 

120 

2.19 

70 

1000 

398.65“ 

65 

35 

0 

53 

2.08 

94 

668 

230.15 

85* 

15 

0 

69 

2.11 

80 

773 

219.85 

65 

35 

0 

86 

2.13 

79 

553 

223.30 

70*** 

30 

0 

114 

2.29 

78 

1000 

262.75 

*  * 

50 

0 

58 

2.50 

63 

1000 

241.80 

*  * 

55 

0 

47 

2.33 

46 

639 

194.00*  *  * 

45 

55 

0 

109 

2.30 

73 

629 

215.70 

65 

35 

0 

75 

2.28 

102 

1000 

247.35 

70*** 

30 

0 

30 

2.36 

45 

839 

161.05* 

55 

45 

0 

98 

2.47 

79 

1000 

352.40*** 

50 

40 

10 

81 

2.44 

97 

1000 

245.95 

35** 

60 

5 

64 

2.42 

62 

1000 

271.65 

*  * 

50 

5 

36 

2.16 

57 

1000 

208.55 

*  * 

55 

0 

92 

2.05 

154 

999 

436.80* 

80** 

20 

0 

103 

2.22 

60 

682 

211.50 

70*** 

30 

0 

41 

2.25 

51 

549 

162.60** 

30* 

70 

0 
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The  results  led  to  a  new  set  of  bounds,  defined  in  Equation  C.4.  The  results  are  shown 
in  Table  C.4.  Notiee  all  eombinations  of  parameters  yield  at  least  loeally  optimal  results. 


2.05  <  c  <  2.3 
30  <  5  <  90 


(C.4) 


Table  C.4:  Performanee  data  for  fourth  set  of  DOE  bounds  on  two  parameter  study 


s 

e 

min 

max 

avg 

global 

loeal 

other 

56 

2.08 

77 

761 

217.85 

70*** 

30 

0 

45 

2.07 

108 

1000 

280.15*** 

00 

o 

20 

0 

56 

2.08 

92 

580 

185.95 

50*** 

50 

0 

68 

2.10 

90 

566 

207.30 

55 

45 

0 

86 

2.24 

60 

979 

251.30 

75** 

25 

0 

49 

2.30 

46 

694 

153.55 

40* 

60 

0 

41 

2.21 

55 

220 

108.40* 

65 

35 

0 

83 

2.19 

65 

1000 

307.35** 

70*** 

30 

0 

60 

2.18 

66 

908 

212.60 

60 

40 

0 

30 

2.20 

46 

728 

178.85*** 

45** 

55 

0 

75 

2.28 

51 

694 

259.75 

70*** 

30 

0 

64 

2.27 

47 

1000 

248.55 

50*** 

50 

0 

53 

2.25 

54 

942 

199.15 

75** 

25 

0 

34 

2.11 

70 

996 

226.45 

65 

35 

0 

71 

2.05 

124 

1000 

354.30* 

60 

40 

0 

79 

2.14 

72 

1000 

232.30 

75** 

25 

0 

38 

2.16 

61 

826 

161.00** 

40* 

60 

0 

134 


The  results  led  to  a  new  set  of  bounds,  defined  in  Equation  C.5.  The  results  are  shown 
in  Table  C.5.  Notiee  all  eombinations  of  parameters  yield  at  least  loeally  optimal  results. 


2.07  <  c  <  2.25 
30  <  5  <  80 


(C.5) 


Table  C.5:  Performanee  data  for  fifth  set  of  DOE  bounds  on  two  parameter  study 


s 

e 

min 

max 

avg 

global 

loeal 

other 

80 

2.13 

74 

880 

269.35*** 

70*** 

30 

0 

43 

2.08 

96 

966 

298.55** 

65 

35 

0 

52 

2.09 

108 

1000 

327.60* 

75** 

25 

0 

61 

2.10 

77 

546 

177.65*** 

00 

o 

20 

0 

77 

2.21 

76 

1000 

238.65 

45* 

55 

0 

46 

2.25 

44 

835 

194.80 

45* 

55 

0 

39 

2.18 

53 

1000 

174.35** 

55*** 

45 

0 

74 

2.17 

70 

722 

191.25 

60 

40 

0 

55 

2.16 

73 

538 

185.90 

50** 

50 

0 

30 

2.19 

53 

256 

116.60* 

55*** 

45 

0 

68 

2.24 

61 

646 

216.25 

50** 

50 

0 

58 

2.23 

53 

892 

227.55 

60 

40 

0 

49 

2.22 

51 

1000 

237.50 

60 

40 

0 

33 

2.12 

69 

1000 

196.40 

60 

40 

0 

64 

2.07 

114 

617 

223.10 

65 

35 

0 

71 

2.14 

76 

720 

199.35 

65 

35 

0 

36 

2.15 

68 

1000 

192.40 

55*** 

45 

0 

The  results  from  this  study  led  to  the  eonelusion  that  to  the  following  bounds  on 
bounds  on  c  and  s.  It  is  expeeted  that  these  bounds  provide  the  best  balanee  between 
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convergence  and  computational  speed  for  the  single  pass  RTM  problems. 


2.09  <  c  <  2.13 
30  <  5  <  60 


(C.6) 
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1 

2 

3 

4 

5 

6 

7 

8 

9 

10 

II 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 


Appendix  D:  Code  for  Impulsive  Responsive  Theater  Maneuvers 


D.l  Single  Pass  RTMs 

D.1.1  Single  Pass  RTM  Data  Script 

to  =  0; 

GMSTO  =  0; 

latlim  =  [-10  10]*pi/180; 
longlim  =  [-50  -10]*pi/180; 


wgs84data 
global  MU 

rOvec  =  [6800  7300;0  0;0  0]; 

vOvec  =  [0  0; 5 .41376581448788  sqrt (MU/7300) /sqrt (2)  ;  5 . 4 1 3 76 5 8 1448788 
sqrt (MU/7300) /sqrt (2) ] ; 


swarm  = 

30; 

iter  = 

1000; 

aevec  = 

[50  60 

70  80  90 

100 

no  120  130 

bevec  = 

[5  6  7 

8  9  10  11 

12 

13  14  15]; 

Rmaxvec 

=  [6850 

7350]  ; 

Rminvec 

=  [6750 

7250]  ; 

prec  = 

[2;5;16] 

J 

for  k  = 

1 :  1 

rO  =  rOvec ( : , k) ; 
vO  =  vOvec  (  :  , k) ; 

Rmax  =  Rmaxvec(k); 

Rmin  =  Rminvec(k); 

[a  ,  ecc , inc , RAAN , w , nuO]  =  RV2C0E (rO , vO) ; 
period  =  2*pi*sqrt(a''3/MU)  ; 
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26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 


state0= [rO  vO] ; 


fprintf (fid , ’ \n\n\n\r  %s  %3i\r\n ’ , ’ rO= ’ , norm(r0) ) ; 

for  aa  =  11:11 

ae  =  aevec (aa)  ; 
be  =  bevec (aa)  ; 

fprintf (fid ,  * \n\n\n\r  %s  %3i\r\n ’ , *  swarm= ’ , swarm)  ; 
fprintf(fid, '%s  %3i\r\n’ , *ae=’ ,ae) ; 
fprintf (fid , * %s  %3i\r\n * , * be= ’ , be) ; 
fprintf (fid , ’ %s  %3i\r\n * , ’ maxi ter = ’ , iter ) ; 

fprintf (fid ,* %2 s  %10s  %8s  %8s  %8s  %8s\r\n ’ , ’ run  # ’ , ’ T1 ’ , * thetal ’ 
, ’ J  * ,  ’ iterations ’  ,  ’ Run  Time ’ ) ; 

itn  =  zeros  (20,1); 
rt  =  zeros  (20 , 1)  ; 
tot_time  =  0; 

for  h  =  20:20 

clear  JG  Jpbest  gbest  manDV 

tstart  =  tic; 

[rf 1 , vf 1 , tf 1 , lat_enter , long_enter , R_exit , V_exit , t_exit , 
lat_exit , long_exit]  =  zone_entry_exit2 (r0 , v0 , GMST0 , t0 , 
latlim , longlim) ; 
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54 

55 

56 

57 

58 

59 

60 

61 

62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 

74 

75 

76 

77 

78 

79 

80 

81 

82 


[ JG , Jpbest , gbest , x , iter_needed , preburn_state 1 , initial_target 
]  =  PSO_RTM_analytical_prec (2  ,  [  1200  period;0  2*pi],prec, 
iter , swarm , r£l , v£l , ae , be , Rmax , Rmin , latlim , longlim , t£l) ; 

tend  =  toc(tstart) 

DVl  =  norm(preburn_state 1(8:10) *10 00)  ; 
manDV  =  round  (JG*  1000*  10''  5)  /lO''  5  ; 
itn(h)  =  iter_needed; 
rt(h)  =  tend; 

i£  h  ==  1 

minDV  =  manDV ; 
mincount  =  1; 
elsei£  manDV  <  minDV 
minDV  =  manDV ; 
mincount  =  1; 
elsei£  manDV  ==  minDV 

mincount  =  mincount  +  1; 

end 

£print£(£id,  ’%2i  %10.2£  %8.5£  %10.5£  %4i  %10 . 4£\r\n , gbest 
(1) ,gbest(2) , manDV , itnCh) , rt (h) ) ; 

end 

gpercent  =  mincount /h* 100 ; 

tot_time  =  tot_time  +  sum(rt) ; 

mintime  =  min(rt); 

maxtime  =  max(rt); 

meantime  =  mean(rt); 

miniter  =  min(itn); 

maxiter  =  max(itn); 
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83 


meaniter  =  mean(itn) ; 

, mintime)  ; 

, maxtime) ; 

, meantime) ; 
, miniter )  ; 

, maxiter )  ; 

, meaniter)  ; 
, gpercent)  ; 

91  end 

92  fprintf  (fid  ,  ’  \n\n\n\r  %s  ’  ,  ’ 


84 

fprintf (fid , 

’%s 

%8. 5f\r\n’ 

,  ’min 

time  = 

85 

fprintf (fid , 

’%s 

%8. 5f\r\n’ 

,  ’max 

time  = 

86 

fprintf (fid , 

’%s 

%8. 5f\r\n’ 

,  ’  avg 

time  = 

87 

fprintf (fid , 

’%s 

%8. 5f\r\n’ 

,  ’min 

iter  = 

88 

fprintf (fid , 

’%s 

%8. 5f\r\n’ 

,  ’max 

iter  = 

89 

fprintf (fid , 

’%s 

%8. 5f\r\n’ 

,  ’  avg 

iter  = 

90 

fprintf (fid , 

’%s 

%i\r\n ’ , ’ global 

conv  = 

’): 


93  end 

D.1.1.1  Constants  and  Parameters 

1  function  wgs84data 

2  % 


0/ (V  0/ 0/ 0/ 0/ Q/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ Q/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ Q/ 0/ 0/ 0/ (V  0/ 

7o7o7o7o7o7q7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7q7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7q7o7o7o7o7o7o7o7o7o7o7o7o7o7q7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o 


3  %%  function  wgs84data 

4  %%  This  script  provides  global  conversion  factors  and  WGS  84  constants 

5  %%  that  may  be  referenced  by  subsequent  MatLab  script  files  and 

functions . 

6  %%  Note  these  variables  are  case  -  specif ic  and  must  be  referenced  as  such 

7  %% 

8  %%  The  function  must  be  called  once  in  either  the  MatLab  workspace  or 

from  a 

9  %%  main  program  script  or  function.  Any  function  requiring  all  or  some 

of  the 

10  %%  variables  defined  must  be  listed  in  a  global  statement  as  follows , 

11  %% 
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%%  global  Deg  Rad  MU  RE  OmegaEarth  SidePerSol  RadPerDay  SecDay  Flat 
EEsqrd  . . . 

%%  EEarth  32  13  14  GMM  GMS  AU  HalfPI  TwoPI  Zero_IE  Small 

Undefined 


%% 

%%  in  part  or  in  its  entirety.  Order  is  not  relevent.  Case  is. 
%% 

% 


0/ (V  0/ 0/ 0/ 0/ Q/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ Q/ 0/ (V  0/ 0/ 0/ 0/ Q/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ Q/ 0/ 0/ 0/ (V  0/ 

7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o7o 


%%  Originally  written  by  Capt  Dave  Vallado 

%%  Modified  and  Extended  for  Ada  by  Dr  Ron  Lisowski 

%%  Extended  from  DFASMath.adb  by  Thomas  L.  Yoder,  LtCol ,  Spring  80 

% 


0/ (V  0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ Q/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (y  0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 0/ 0/ 0/ 0/ 0/ (V  0/ 

/o /o /o /o /o /o /o /o /o /o /o  7o /o /o /o /o /o /o  7o  7o /o /o /o /o /o /o  7o  7o /o /o /o /o /o  7o /o /o /o /o /o /o /o  7o  7o /o /o /o /o /o  7o /o /o /o /o /o /o /o  7o  7o /o /o /o /o /o /o  7o /o /o /o /o /o /o  7o /o /o /o /o /o /o /o 


global  Deg  Rad  MU  RE  OmegaEarth  SidePerSol  RadPerDay  SecDay  Flat  EEsqrd 


EEarth  12  13  14  GMM  GMS  AU  HalfPI  TwoPI  Zero_IE  Small  Undefined 
gO 


%%  Degrees  and  Radians 


Deg=180 . 0/pi ; 

%%  deg/rad 

Rad=  pi/180.0; 

%%  rad/deg 

%%  Earth  Characteristics  from  WGS  84 
MU=398608. 5 ; 
sec  “  2 

RE=6378. 137; 

OmegaEarth=0.000872921151467; 
SidePerSol  =  1 .002  7379093  5  : 
RadPerDay =6. 30038809866574; 


%%  km “3/ 

%%  km 

%%  rad/sec 

%%  Sidereal  Days/Solar  Day 
%%  rad/day 
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%%  sec/day 


SecDay  =  86400 . ® ; 

Flat  =  l .0/298.2  5722  3  563  ;  %% 

EEsqrd=C2 . 0  -  Flat) ''Flat ; 

EEarth=sqrt (EEsqrd) ; 

J2=  0.00108263; 

J3=-0. 00000254; 

J4=-0. 00000161; 

90=9.81; 

%%  Moon  &  Sun  Characteristics  from  WGS  84 

GMM=  4902.774191985;  %%  km''3/sec''2 

GMS=  1 .  32712438E11 ;  %%  km''3/sec''2 

AU=  149597870.0;  %%  km 

%%  HALFPI,PI2  PI/2,  &  2PI  in  various  names 

Hal£PI=  pi/2.0; 

TwoPI=  2 . 0*pi ; 

Zero_IE  =  0.015;  %%  Small  number  for  incl  &  ecc 

purposes 

Small  =  1.0E-6;  %%  Small  number  used  for 

tolerance  purposes 
Undef ined=  999999 . 1 ; 

D.1.1.2  Determine  Classical  Orbital  Elements  for  Position  and  Velocity 
Vectors 

function  [a , ecc , inc , RAAN , w , nu]  =  RV2C0E(r,v) 

%Author :  Dan  Showalter  18  Oct  2012 

%Purpose:  Compute  classical  orbital  elements  for  a  position  and  velocity 
%vector.  Based  on  algorithm  in  Bate/Mueller/White  Fundamentals  of 
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%Astrodynamics 


%%  Algorithm 
global  MU 

khat  =  [0 ; ® ; 1] ; 

%  calculate  angular  momentum  vector 
h  =  cross (r , v) ; 

%  calculate  nodal  vector 
n  =  cross (khat , h) ; 

%calculate  eccentricity  vector 

evec  =  l/MU''(Cnorm(v) ''Z  -  MU/norm(r) ) '-r 

%  eccentricity 
ecc  =  normCevec) ; 

%  compute  specific  mechanical  energy 

SME  =  normCv)''2/2  -  MU/norm(r)  ; 

%  compute  semimajor  axis 
a  =  -MU/(2*SME) ; 

% compute  inclination 
inc  =  acos Ch(3) /normCh) ) ; 

%  compute  RAAN 

RAAN  =  acosCn(l)/norm(n)) ; 


-  dot(r ,v)*v) ; 
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i£  n(2)  <  0 

RAAN  =  2*pi-RAAN; 

end 

if  ecc  <=  0.00001 
ecc  =  0; 
w  =  0 ; 

nu  =  acos (dot (n , r) / (norm(n) *norm(r) ) ) ; 

if  imag(nu)  "=  0 

temp  =  dot  (n ,  r)  /(normCn)  ''norm(r)  )  ; 
if  abs(temp)  >  1 

temp  =  sign(temp) *1 ; 
nu  =  acos (temp) ; 

end 

end 

if  r(3)  <  0 

nu  =  2  *  p i  -  nu ; 

end 

else 

w  =  acos (dot (n, evec) / (norm (n)* norm (evec))) ; 

if  evec(3)  <  0 

w  =  2*pi  -w  ; 

end 

nu  =  acos  (dot  (evec  ,  r)  /  (norm(evec)  ''norm(r)  )  )  ; 
if  imag(nu)  “=  0 

temp  =  dot  (evec  ,  r)  /(norm(evec)  ''norm(r)  )  ; 
if  abs(temp)  >  1 

temp  =  sign(temp) *1 ; 
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nu  =  acos (temp)  ; 

end 

end 

if  dotCr.v)  <  ® 

nu  =  2* pi  -  nu ; 

end 

end 

D.1.1.3  Determine  Spacecraft  Entry  into  Exclusion  Zone 

function  [R_enter , V_enter , t_enter , lat_enter , long_enter , R_exit , V_exit , 
t_exit , lat_exit , long_exit]  =  zone_entry_exit2(rQ,v0,GMST0,t8,latlim, 
longlim) 

%UNTITLED2  This  function  takes  a  spacecraft’s  initial  position/velocity 
%vectors ,  initial  time ,  initial  greenwich  mean  time  and  latitude  and 
%longitude  limits  and  produces  the  spacecraft’s  first  entry  and  exit 
%conditions  into  the  exclusion  zone 

%INPUTS 


r®  = 

inertial 

initial 

position 

vector 

(km) 

V®  = 

inertial 

initial 

velocity 

vector 

(km) 

GMST® 

=  initi 

al  greenwhich  mean 

standard  time 

%  t®  =  initial  time  (sec) 

%0UTPUTS 

%  R_enter  =  inertial  entry  position  into  exclusion  zone  (km) 

%  V_enter  =  inertial  velocity  vector  into  exclusion  zone  (km) 

%  t_enter  =  entry  time  into  exclusion  zone 

%  lat_enter  =  latitude  of  spacecraft  when  it  enters  exclusion  zone  ( 
rad) 

%  long_enter  =  longitude  of  spacecraft  when  it  enters  exclusion  zone  ( 
rad) 

%  R_exit  =  inertial  exit  position  out  of  exclusion  zone  (km) 
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%  V_exit  =  inertial  velocity  vector  out  of  exclusion  zone  (km) 

%  t_exit  =  exit  time  into  exclusion  zone 

%  lat_exit  =  latitude  of  spacecraft  when  it  exits  exclusion  zone  (rad) 
%  long_exit  =  longitude  of  spacecraft  when  it  exits  exclusion  zone  ( 
rad) 

%% 

wgs84data 
global  MU 

longlim_temp  =  longlim; 
if  longlim(2)  <  0 

longlim_temp  (2)  =  2*pi  +  longlim(2); 

end 

if  longlim(l)  <  0 

longlim_temp  (1)  =  2*pi  +  longlim(l); 

end 

if  longlim_temp (1)  >  longlim_temp (2) 

longlim_temp (1)  =  longlim_temp ( 1)  -  2*pi; 
weird_flag  =  1; 

else 

weird_flag  =  0; 

end 

zone_long_dif f  =  longlim_temp (2)  -  longlim_temp (1) ; 


[a  ,  ecc  ,  inc  ,  RAAN  ,  w  ,  nu0]  =  RV2C0E  (r0  ,  v0)  ; 

period  =  2''pi ''sqrt  (a"  3/MU)  ; 

%%  Find  spacecraft  entry  and  exit  points  into  exclusion  zone 
%determine  exclusion  zone  entry/exit  times  underneath  orbit  plane 
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[nu_enter_AN , nu_exit_AN , nu_enter_DN , nu_exit_DN]  =  exclusion_nu_intercept 
(latlim  , inc , w) ; 


%=========== Ascending  node  opportunity 


%Determine  inertial  position  vector  to  nu_enter_AN  and  nu_exit_AN 
[R_enter_AN , V_enter_AN]  =  C0E2RV (a , ecc , inc , RAAN , w , nu_enter_AN) ; 
[R_exit_AN , V_exit_AN]  =  C0E2RV (a , ecc , inc , RAAN , w , nu_exit_AN) ; 

%determine  time  of  flight  from  nuQ  to  nu_enter_AN  and  nu_exit_AN 
[T0F_enter_AN]  =  T0F_from_nu (a , ecc , nuQ , nu_enter_AN , ; 
[T0F_exit_AN]  =  T0F_from_nu (a , ecc , nu0 , nu_exit_AN , 0) ; 

if  T0F_enter_AN  <  20  &&  T0F_enter_AN  >  0 
T0F_enter_AN  =  T0F_enter_AN  +  period; 

T0F_exit_AN  =  T0F_exit_AN  +  period; 

end 

if  T0F_exit_AN  <  T0F_enter_AN 
if  T0F_enter_AN  >  0 

T0F_exit_AN  =  TOF_exit_AN  +  period; 

else 

T0F_enter_AN  =  TOF_enter_AN  +  2''period; 

T0F_exit_AN  =  T0F_exit_AN  +  period; 

end 

end 

%============ Descending  node  opportunity 


%Determine  inertial  position  vector  to  nu_enter_DN  and  nu_exit_DN 
[R_enter_DN , V_enter_DN]  =  C0E2RV (a , ecc , inc , RAAN , w , nu_enter_DN) ; 
[R_exit_DN , V_exit_DN]  =  C0E2RV (a , ecc , inc , RAAN , w , nu_exit_DN) ; 
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%determine  time  of  flight  from  nuO  to  nu_enter_DN  and  nu_exit_DN 
[T0F_enter_DN]  =  T0F_from_nu (a , ecc , nuO , nu_enter_DN , 0) ; 

[TOF_exit_DN]  =  TOF_from_nu (a , ecc , nuO , nu_exit_DN , ®) ; 

if  TOF_enter_DN  <  20  &&  TOF_enter_DN  >  0 
TOF_enter_DN  =  TOF_enter_DN  +  period; 

TOF_exit_DN  =  TOF_exit_DN  +  period; 

end 

if  TOF_exit_DN  <  TOF_enter_DN 
if  TOF_enter_DN  >  0 

TOF_exit_DN  =  TOF_exit_DN  +  period; 

else 

TOF_enter_DN  =  TOF_enter_DN  +  2''period; 

TOF_exit_DN  =  TOF_exit_DN  +  period; 

end 

end 

flag  =  0; 
count  =  0; 

%  determine  is  satellite  is/is  not  in  correct  longitude  range  when  it  is 
in  correct 

%  latitude  range.  If  not,  find  the  next  time  it  will  be  in  the  correct 
longitude 
%  range 

while  flag  ==  0; 

%Determine  lattitude  and  longitude  of  spacecraft  at  nu_enter_AN  and 
nu_exit_AN 
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[lat_enter_AN , long_enter_AN , GMST_enter_AN]  =  I JK_to_LATLONG ( 

R_enter_AN (1) , R_enter_AN (2) , R_enter_AN (3) , GMSTO , t0+TOF_enter_AN) 
» 

[lat_exit_AN , long_exit_AN , GMST_exit_AN]  =  I JK_to_LATLONG (R_exit_AN 
(1) ,R_exit_AN(2) , R_exit_AN (3) , GUSTO , tO+TOF_exit_AN) ; 

if  long_enter_AN  <  0 
if  weird_flag  ==  0 

long_enter_AN_temp  =  2*pi  +  long_enter_AN ; 

else 

long_enter_AN_temp  =  long_enter_AN ; 

end 

else 

long_enter_AN_temp  =  long_enter_AN ; 

end 

if  long_exit_AN  <  0 

if  weird_flag  ==  0 

long_exit_AN_temp  =  2*pi  +  long_exit_AN ; 

else 

long_exit_AN_temp  =  long_exit_AN ; 

end 

else 

long_exit_AN_temp  =  long_exit_AN ; 

end 


%Deterraine  lattitude  and  longitude  of  spacecraft  at  nu_enter_AN  and 
nu_exit_AN 

[lat_enter_DN , long_enter_DN , GMST_enter_DN]  =  I JK_to_LATL0NG ( 

R_enter_DN (1) , R_enter_DN (2) , R_enter_DN (3) , GUSTO , tO+TOF_enter_DN) 
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[lat_exit_DN , long_exit_DN , GMST_exit_DN] 


IJK_to_LATLONG(R_exit_DN 


(1) ,R_exit_DN(2) , R_exit_DN (3) ,GMST0 , tO+TOF_exit_DN) ; 
flag  ; 

if  long_enter_DN  <  0 
if  weird_flag  ==  0 

long_enter_DN_temp  =  2*pi  +  long_enter_DN ; 

else 

long_enter_DN_temp  =  long_enter_DN ; 

end 

else 

long_enter_DN_temp  =  long_enter_DN ; 

end 

if  long_exit_DN  <  ® 

if  weird_flag  ==  Q 

long_exit_DN_temp  =  2*pi  +  long_exit_DN ; 

else 

long_exit_DN_temp  =  long_exit_DN ; 

end 

else 

long_exit_DN_temp  =  long_exit_DN ; 

end 


if  (longlim_temp (1)  <=  long_enter_AN_temp  &&  long_enter_AN_temp  <= 
longlim_temp (2) )  ||  (longlim_temp (1)  <=  long_exit_AN_temp  && 
long_exit_AN_temp  <  longlim_temp (2) ) 
flag  =  1; 

AN  =  1; 
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if  Clonglim_temp (1)  <=  long_enter_AN_temp  &&  long_enter_AN_temp 
<=  longlim_temp (2) )  &&  (longliin_temp (1)  <=  long_exit_AN_temp 


&&  long_exit_AN_temp  <  longlim_temp (2) ) 
nu_enter  =  nu_enter_AN ; 
t_enter  =  t®  +  T0F_enter_AN ; 
nu_exit  =  nu_exit_AN ; 
t_exit  =  t®  +  T0F_exit_AN; 
elseif  (longlim_temp (1)  <=  long_enter_AN_temp  && 

long_enter_AN_temp  <=  longlim_temp (2) )  %Exact  entry  location 
known,  but  exact  exit  unknown 
nu_enter  =  nu_enter_AN ; 
t_enter  =  t®  +  TOF_enter_AN ; 
t_exit_guess  =  t®  +  TOF_exit_AN ; 

[nu_exit , t_exit]  =  exclusion_exit_condition_dual2 (a , ecc , inc , 
RAAN , w , nu® , longlim ,t_exit_guess , t_enter , GMST®) ; 
else  %Exact  entry  unknown,  but  exact  exit  location  known 
nu_exit  =  nu_exit_AN ; 
t_exit  =  t®  +  TOF_exit_AN; 
t_enter_guess  =  t®  +  TOF_enter_AN ; 

[nu_enter , t_enter ]  =  exclusion_entry_condition_dual2 (a , ecc  , 
inc , RAAN , w , nu® , longlim , t_exit , t_enter_guess , GUST®) ; 

end 

elseif  Clonglim_temp (1)  <=  long_enter_DN_temp  &&  long_enter_DN_temp 
<=  longlim_temp (2) )  ||  (longlim_temp (1)  <=  long_exit_DN_temp  && 
long_exit_DN_temp  <  longlim_temp (2) ) 
flag  =  1; 

AN  =  2; 

if  Clonglim_temp (1)  <=  long_enter_DN_temp  &&  long_enter_DN_temp 
<=  longlim_temp (2) )  &&  (longlim_temp (1)  <=  long_exit_DN_temp 
&&  long_exit_DN_temp  <  longlim_temp (2) ) 
nu_enter  =  nu_enter_DN ; 
t_enter  =  t®  +  TOF_enter_DN ; 
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nu_exit  =  nu_exit_DN ; 
t_exit  =  tIS  +  TOF_exit_DN; 
elseif  (longlim_temp (1)  <=  long_enter_DN_temp  && 

long_enter_DN_temp  <=  longlim_temp (2) )  %Exact  entry  location 
known,  but  exact  exit  unknown 
nu_enter  =  nu_enter_DN ; 
t_enter  =  tO  +  TOF_enter_DN ; 
t_exit_guess  =  t0+  TOF_exit_DN ; 

[nu_exit , t_exit]  =  exclusion_exit_condition_dual2 (a , ecc , inc , 
RAAN , w , nuO , longlim ,t_exit_guess , t_enter , GMSTO) ; 
else  %Exact  entry  unknown,  but  exact  exit  location  known 
nu_exit  =  nu_exit_DN ; 
t_exit  =  tIS  +  TOF_exit_DN; 
t_enter_guess  =  tO  +  TOF_enter_DN ; 

[nu_enter , t_enter ]  =  exclusion_entry_condition_dual2 (a , ecc , 
inc , RAAN , w , nuQ , longlim , t_exit , t_enter_guess , GUST®) ; 

end 

elseif  flag  1 

long_dif f_AN_temp  =  long_exit_AN  -  long_enter_AN ; 
if  long_diff_AN_temp  <  Q 

long_diff_AN_temp  =  long_diff_AN_temp  +  2*pi; 

end 

long_dif f_DN_temp  =  long_exit_DN_temp  -  long_enter_AN_temp ; 
if  long_exit_DN_temp  <  long_enter_DN_temp 

long_diff_DN_temp  =  long_diff_DN_temp  +  2*pi; 

end 

if  long_diff_AN_temp  >  zone_long_dif f  &&  long_enter_AN  <  longlim 
(1)  &&  long_exit_AN  >  longlim(2) 
flag  =  1; 

nu_exit_guess  =  nu_exit_AN; 
t_exit_guess  =  tO  +  TOF_exit_AN ; 
t_enter_guess  =  tO  +  TOF_enter_AN ; 
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[nu_enter , t_enter , phi_enter , lam_enter]  = 

exclusion_entry_condition_dual2(a,ecc,inc, RAAN , w , nuQ , 
longlim , t_exit_guess , t_enter_guess , GMST®) ; 

[nu_exit , t_exit , phi_exit , lam_exit]  = 

exclusion_exit_condition_dual2 (a , ecc , inc , RAAN , w , nu8 , 
longlim  ,  t_exit_guess  ,  t_enter  ,  GMST8)  ; 

%not  a  valid  entry  if  before  t®  or  if  the  longitude  does  not 
match 

%the  limits 

if  t_enter  <  ®  ||  abs (lam_enter  -  longlim(l))  >  ®.®®1  || 

abs(lam_exit  -  longlim(2))  >  ®.®®1 
flag  =  ®; 

end 

end 

if  long_diff_DN_temp  >  zone_long_dif f  &&  long_enter_DN  <  longlim 
(1)  &&  long_exit_DN  >  longlim(2) 
flag  =  1; 

nu_exit_guess  =  nu_exit_DN; 
t_exit_guess  =  t®  +  TOF_exit_DN ; 
t_enter_guess  =  t®  +  TOF_enter_DN ; 

[nu_enter , t_enter , phi_enter , lam_enter]  = 

exclusion_entry_condition_dual2(a,ecc,inc, RAAN , w , nu® , 
longlim , t_exit_guess , t_enter_guess , GMST®) ; 

[nu_exit , t_exit , phi_exit , lam_exit]  = 

exclusion_exit_condition_dual2 (a , ecc , inc , RAAN , w , nu® , 
longlim  ,  t_exit_guess  ,  t_enter  ,  GMST®)  ; 

%not  a  valid  entry  if  before  t®  or  if  the  longitude  does  not 
match 

%the  limits 

if  t_enter  <  ®  ||  abs (lam_enter  -  longlim(l))  >  ®.®®1  || 

abs(lam_exit  -  longlim(2))  >  ®.®®1 
flag  =  ®; 
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end 


end 


end 

%Exact  and  exit  unknown  but  spacecraft  passes  through  the  exclusion 
zone 


if  flag  0 

if  t_enter  <  tO 
flag  =  0; 

end 

end 

if  flag  ==  0 

TOF_enter_AN  =  TOF_enter_AN  +  period; 
TOF_exit_AN  =  TOF_exit_AN  +  period; 
TOF_enter_DN  =  TOF_enter_DN  +  period; 
T0F_exit_DN  =  TOF_exit_DN  +  period; 

count  =  count  +  1; 

if  count  ==  100 
error 

end 

end 


end 

[R_enter , V_enter ]  =  COE2RV (a , ecc , inc , RAAN , w , nu_enter) ; 
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[lat_enter , long_enter , GMST_enter]  =  I JK_to_LATLONG(R_enter (1) , R_enter  (2) 
, R_enter (3) , GMST0 , t_enter ) ; 

[R_exit , V_exit]  =  C0E2RV (a , ecc , inc , RAAN , w , nu_exit)  ; 

[lat_exit , long_exit , GMST_enter]  =  I JK_to_LATLONG(R_exit (1) , R_exit (2) , 
R_exit (3) , GMST0 , t_exit)  ; 


end 


D,1.1.4  Determine  True  Anomaly  of  Spacecraft  at  Exclusion  Zone  Entry 

function  [nu_enter_AN , nu_exit_AN , nu_enter_DN , nu_exit_DN]  = 
exclusion_nu_intercept (latlim , incl , omega) 

%exclusion_zone_orbi t_intercept  determines 

%  1)  the  true  anomalies  of  the  orbit  when  it  intersects  the  minimum 

and 

%  maximum  latitudes  of  the  exclusion  zone  for  botht  he  ascending  node 
%  (AN)  and  descending  node  (DN)  passes. 

%INPUTS : 

%  latlim  =  [phi_min  phi_max] 

%  phi_min  =  the  minimum  latitude  bound  (rad) 

%  phi_max  =  the  maximum  latitude  bound  (rad) 

%  incl  =  orbit  inclination  (rad) 

%  omega  =  orbit  argument  of  perigee 

%0UTPUTS 

%  nu_enter_AN  =  limit  of  true  anomaly  of  spacecraft  at  entry  into 
%  exclusion  zone  on  AN  pass 
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limit  o£  true  anomaly  of  spacecraft  at  exit  exclusion 


%  nu_exit_AN  = 
zone 

%  on  AN  pass 

%  nu_enter_DN  =  limit  of  true  anomaly  of  spacecraft  at  entry  into 
%  exclusion  zone  on  DN  pass 

%  nu_exit_DN  =  limit  of  true  anomaly  of  spacecraft  at  exit  exclusion 
zone 

%  on  DN  pass 

%% 


phi_min  =  latlim(l); 
phi_max  =  latlim(2); 

%% 

if  incl  “=  pi/2 

%%  ***y,****y,****y,************pj^Q(^j^^j^j.  ORBITS 

if  incl  <  pi/2 

alpha  =  incl ; 

else 

alpha  =  pi  -  incl ; 

end 


%========================== AN  passes 


%  1)  Exclusion  zone  1st  point  beneath  orbit  plane  Cphi_min , 
lambda_max) 

delta_nu_enter_AN  =  asin CsinCnorm(phi_min) ) /sin (alpha) ) ; 
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if  phi_min  >  8 

nu_enter_AN  =  delta_nu_enter_AN  -  omega; 
elseif  phi_min  <  8 

nu_enter_AN  =  2*pi  -  omega  -  delta_nu_enter_AN ; 

else 

nu_enter_AN  =  2*pi  -  omega; 

end 


%  2)  Exclusion  zone  last  point  out  from  under  orbit  plane  (phi_max , 
lambda_min) 

delta_nu_exit_AN  =  asin(sinCnorm(phi_max))/sin(alpha)) ; 


if  phi_max  >  8 
nu_exit_AN 
elseif  phi_max 
nu_exit_AN 

else 

nu_exit_AN 


=  delta_nu_exit_AN  -  omega; 

<  8 

=  2*pi  -  omega  -  delta_nu_exit_AN ; 

=  2*pi  -  omega; 


end 


% 


DN  passes 


%Exclusion  zone  1st  point  beneath  orbit  plane  (phi_max ,  lambda_max) 
delta_nu_enter_DN  =  asin(sinCnorm(phi_max))/sin(alpha)) ; 


if  phi_max  >  8 

nu_enter_DN  =  pi 
elseif  phi_max  <  8 
nu_enter_DN  =  pi 

else 

nu_enter_DN  =  pi 

end 


omega  -  delta_nu_enter_DN ; 


omega  +  delta_nu_enter_DN ; 


omega ; 
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%Exclusion  zone  last  point  out  from  under  orbit  plane  (phi_min , 


lambda_min) 

delta_nu_exit_DN  =  asin ( sin (norm (phi_min) ) /sin (alpha) ) ; 


if  phi_min  >  0 

nu_exit_DN  =  pi 
elseif  phi_min  <  ® 
nu_exit_DN  =  pi 

else 

nu_exit_DN  =  pi 

end 

elseif  incl  ==  pi/2 


omega  -  delta_nu_exit_DN ; 


omega  +  delta_nu_exit_DN ; 


omega ; 


%% 


*****  polar  orbits 


% 


AN  PASS 


%Exclusion  zone  1st  point  in  lambda_max 
if  phi_min  >  0 

nu_enter_AN  =  norm (phi_min)  -  omega; 
elseif  phi_min  <  Q 

nu_enter_AN  =  2*pi  -  norm(phi_min)  -  omega; 

else 

nu_enter_AN  =  2*pi  -  omega; 

end 

if  phi_max  >  0 

nu_exit_AN  =  norm (phi_max)  -  omega; 
elseif  phi_max  <  Q 

nu_exit_AN  =  2*pi  -  normCphi_max)  -  omega; 

else 
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nu_exit_AN  =  2*pi  -  omega; 

end 


% 


DN  PASS 


if  phi_max  >  8 

nu_enter_DN  =  pi  -  normCphi_max)  -  omega; 
elseif  phi_max  <  8 

nu_enter_DN  =  pi  +  normCphi_max)  -  omega; 

else 

nu_enter_DN  =  pi  -  omega; 

end 


if  phi_min  >  8 
nu_exit_DN 
elseif  phi_min 
nu_exit_DN 


=  pi  -  norm(phi_min) 
<  8 

=  pi  +  norm(phi_min) 


else 


nu_exit_DN  =  pi  -  omega; 

end 

end 


omega ; 


omega ; 


if 


incl  >  pi  II  incl  <  8 

dispC’Error  in  exclusion_zone_orbit_intercept : 

feasible ’ ) 
clear  nu_enter_AN 


inclination  not 


end 


if  nu_enter_AN  <  8 

nu_enter_AN  =  2*pi  +  nu_enter_AN ; 
elseif  nu_enter_AN  >=  2*pi 

nu_enter_AN  =  2*pi  -  nu_enter_AN ; 
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end 


i£  nu_exit_AN  <  0 

nu_exit_AN  =  2*pi  +  nu_exit_AN; 
elseif  nu_exit_AN  >=  2*pi 

nu_exit_AN  =  2*pi  -  nu_exit_AN; 

end 

i£  nu_enter_DN  <  0 

nu_enter_DN  =  2''pi  +  nu_enter_DN; 
elsei£  nu_enter_DN  >=  2*pi 

nu_enter_DN  =  2''pi  -  nu_enter_DN; 

end 

i£  nu_exit_DN  <  0 

nu_exit_DN  =  2''pi  +  nu_exit_DN; 
elsei£  nu_exit_DN  >=  2*pi 

nu_exit_DN  =  2*pi  -  nu_exit_DN; 

end 

D.1.1,5  Interpolate  to  Find  Exclusion  Zone  Entry 

£unction  [nu_enter , t_enter , lat_enter , long_enter]  = 

exclusion_entry_condi tion_dual2 (a , ecc , inc , RAAN , omega , nu0 , longlim , 
t_exit , t_enter , GMST0) 

%This  £unction  computes  the  the  entry  states  o£  the  spacecra£t 
%into  a  rectangular  exclusion  zone  (direct  orbits  only) 

%INPUTS 

%  a  =  orbit  semimajor  axis  (km) 

%  ecc  =  orbit  eccentricity 

%  inc  =  orbit  inclination  (rad) 

%  nu_exit  =  true  anomaly  o£  spacecra£t  upon  exit  £rom  exclusion  zone 
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%  (rad) 

%  lambda_exit  =  longitude  of  spacecraft  upon  exclusion  zone  exit  (rad) 
%  latlim  =  [phi_min  phi_max] 

%  phi_min  =  the  minimum  latitude  bound  (rad) 

%  phi_max  =  the  maximum  latitude  bound  (rad) 

%  longlim  =  [lambda_min  lambda_max] 

%  lambda_min  =  the  minimum  longitude  bound  (rad) 

%  lambda_max  =  the  maximum  longitude  bound  (rad) 

%0UTPUTS 

%  nu_enter_ex  =  true  anomaly  of  spacecraft  upon  exclusion  zone  entry  ( 
rad) 

%  phi_enter  =  latitude  of  spacecraft  upon  entry  into  exclusion  zone  ( 
rad) 

%  lambda_enter  =  longitude  of  spacecraft  upon  entry  in  exclusion  zone 
(rad) 

%% 

wgs84data 
global  OmegaEarth 

if  inc  <  pi/2 

alpha  =  inc ; 
elseif  inc  >  pi/2 

alpha  =  pi  -  inc ; 

else 

disp (’ ERROR : Inclination  must  be  valid’) 
clear  alpha 

end 

longlim_temp  =  longlim(l) ; 
if  longlim(l)  <  Q 

longlim_temp  =  longlim(l)  +  2*pi: 

end 
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[nu_guess]  =  nu£_£rom_T0F (nuO , t_enter , a , ecc) ; 


[R_guess , V_guess]  =  C0E2RV (a , ecc , inc , RAAN , omega , nu_guess) ; 

[lat_guess , long_guess]  =  I JK_to_LATLONG(R_guess (1) , R_guess (2) , R_guess (3) 
, GMST0 , t_enter ) ; 

i£  longlimCl)  <  0 

long_guess_temp  =  long_guess; 
i£  long_guess  <  0 

long_guess_temp  =  2*pi  +  long_guess; 

end 

%  plot ( (long_guess) *  180/pi , lat_guess  *  180/pi , ’ bO  ’ ) 

del_lambda  =  longlim_temp  -  long_guess_temp ; 

else 

del_lambda  =  longlim(l)  -  long_guess; 

end 

gamma  =  acos(sin(alpha) ''cos(del_lambda))  ; 
del_nu  =  acos  (cot  (gamma) ''cot  (alpha)  )  ; 
nu_guess2  =  nu_guess  +  del_nu; 
i£  nu_guess2  >  2*pi 

nu_guess2  =  nu_guess2  -  2''pi  ; 

end 

delt  =  T0F_£rom_nu (a , ecc , nu_guess , nu_guess2 , 0) ; 
t_guess  =  t_enter  +  delt; 
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[R_guess , V_guess]  =  COE2RV (a , ecc , inc , RAAN , omega , nu_guess2 )  ; 

[lat_guess , long_guess]  =  I JK_to_LATLONG(R_guess (1) , R_guess (2) , R_guess (3) 
, GMST0 , t_guess) ; 
if  longlim(l)  <  0 

long_guess_temp  =  long_guess; 
if  long_guess  <  0 

long_guess_temp  =  2*pi  +  long_guess; 
diff  =  longlim_temp  -  long_guess_temp ; 

else 

diff  =  longlim(l)  -  long_guess_temp ; 

end 

% 

%  plot ( ( long_guess_temp) *  180/pi , lat_guess* 180/pi , ’ bO  ’  ) 
else 

%  plot (long_guess* 180/ pi , lat_guess  *  180/pi , ’ kX ’ ) 
diff  =  longlim(l)  -  long_guess; 

end 


count  =  0; 

while  absCdiff)  >  le-6 

del_lambda  =  del_lambda  +  diff; 

gamma  =  acos ( s in ( alpha )* cos  Cdel_lambda) ) ; 

del_nu  =  acos (cot (gamma) *cot (alpha) ) ; 

nu_guess2  =  nu_guess  +  del_nu; 

if  nu_guess2  >  2''pi 

nu_guess2  =  nu_guess2  -  2*pi; 

end 

delt  =  TOF_from_nu (a , ecc , nu_guess , nu_guess2  ,  0)  ; 
t_guess  =  t_enter  +  delt; 

[R_guess , V_guess]  =  C0E2RV (a , ecc , inc , RAAN , omega , nu_guess2 )  ; 
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[lat_guess , long_guess]  =  I JK_to_LATL0NG (R_guess (1) , R_guess (2) , 
R_guess (3) , GMSTO , t_guess) ; 
if  longlim(l)  <  Q 

long_guess_temp  =  long_guess; 
if  long_guess  <  0 

long_guess_temp  =  2''pi  +  long_guess; 

end 

diff  =  longlim_temp  -  long_guess_temp ; 

%  plot ( (long_guess_temp) *  180/pi , lat_guess  *  180/pi , ’ bO ’ ) 

else 

diff  =  longlim(l)  -  long_guess; 

%  plot (long_guess* 180/pi , lat_guess  *  180/pi , ’ kX  * ) 

end 


end 


t_enter  =  t_guess; 

nu_enter  =  nu_guess2 ; 

R_enter  =  R_guess; 

V_enter  =  V_guess; 
lat_enter  =  lat_guess; 
long_enter  =  long_guess; 

%  hold  on 

%  plot (long_guess (:)* 180/pi, lat_guess (:) *  180/pi , ’ b . ’ ) 

%  plot (long_enter*180/pi , lat_enter*180/pi , ’ gD ’ , lambda_exit *  180/pi , 
phi_exit  *  180/pi , ’ gO  ’ ) 

D.1,1,6  Interpolate  to  Find  Exclusion  Zone  Exit 
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function  [nu_exit , t_exit , lat_exit , long_exit]  = 

exclusion_exit_condition_dual2 (a , ecc , inc , RAAN , omega , nuO , longlim , 
t_exit , t_enter , GMST0) 

%This  function  computes  the  the  entry  states  of  the  spacecraft 
%into  a  rectangular  exclusion  zone  (direct  orbits  only) 

%INPUTS 

%  a  =  orbit  semimajor  axis  (km) 

%  ecc  =  orbit  eccentricity 

%  inc  =  orbit  inclination  (rad) 

%  nu_exit  =  true  anomaly  of  spacecraft  upon  exit  from  exclusion  zone 
%  (rad) 

%  lambda_exit  =  longitude  of  spacecraft  upon  exclusion  zone  exit  (rad) 
%  latlim  =  [phi_min  phi_max] 

%  phi_min  =  the  minimum  latitude  bound  (rad) 

%  phi_max  =  the  maximum  latitude  bound  (rad) 

%  longlim  =  [lambda_min  lambda_max] 

%  lambda_min  =  the  minimum  longitude  bound  (rad) 

%  lambda_max  =  the  maximum  longitude  bound  (rad) 

%0UTPUTS 

%  nu_enter_ex  =  true  anomaly  of  spacecraft  upon  exclusion  zone  entry  ( 
rad) 

%  phi_enter  =  latitude  of  spacecraft  upon  entry  into  exclusion  zone  ( 
rad) 

%  lambda_enter  =  longitude  of  spacecraft  upon  entry  in  exclusion  zone 
(rad) 

%% 

if  inc  <  pi/2 

alpha  =  inc ; 
elseif  inc  >  pi/2 
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alpha  =  pi 


inc  ; 


else 

disp (* ERROR : Inclination  must  be  valid*) 
clear  alpha 

end 

longlim_temp  =  longlim(2); 
i£  longlimC2)  <  0 

longlim_temp  =  longlim(2)  +  2*pi; 

end 

lambda_max  =  longlim(2) ; 

[nu_guess]  =  nu£_£rom_TOF  Cnu0 , t_exit , a , ecc) ; 


[R_guess , V_guess]  =  COE2RV (a , ecc , inc , RAAN , omega , nu_guess) ; 

[lat_guess , long_guess]  =  I JK_to_LATLONG(R_guess (1) , R_guess (2) , R_guess (3) 
, GMST0 , t_exit ) ; 

i£  longlimC2)  <  0 

long_guess_temp  =  long_guess; 
i£  long_guess  <  0 

long_guess_temp  =  2*pi  +  long_guess; 

end 

%  plot ( ( long_guess) *  180/pi , lat_guess  *  180/pi , *  bO  * ) 

del_lambda  =  long_guess_temp  -  longlim_temp ; 

else 

del_lambda  =  long_guess  -longlim(2); 

%  plot  Clong_guess  *  180/pi , lat_guess  *  180/pi , *  rO  ’  ) 

end 
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gamma  =  acos(sin(alpha) ''cos(del_lambda))  ; 
del_nu  =  acos  (cot  (gamma) ''cot  (alpha)  )  ; 
nu_guess2  =  nu_guess  -  del_nu; 
i£  nu_guess2  <  0 

nu_guess2  =  nu_guess2  +  2*pi; 

end 

delt  =  T0F_£rom_nu (a , ecc , nu_guess2 , nu_guess , 0) ; 
t_guess  =  t_exit  -  delt; 

[R_guess , V_guess]  =  C0E2RV (a , ecc , inc , RAAN , omega , nu_guess2 ) ; 

[lat_guess , long_guess]  =  I JK_to_LATLONG(R_guess (1) , R_guess (2) , R_guess (3) 
, GMST0 , t_guess) ; 
i£  longlim(2)  <  0 

long_guess_temp  =  long_guess; 
i£  long_guess  <  0 

long_guess_temp  =  2*pi  +  long_guess; 

end 

di££  =  long_guess_temp  -  longlim_temp ; 

%  plot ( (long_guess) *  180/pi , lat_guess  *  180/pi , ’ bO  ’ ) 

else 

%  plot (long_guess  *  180/pi , lat_guess  *  180/pi , ’ kX ’ ) 
di££  =  long_guess  -longlim(2); 

end 


count  =  0; 

while  abs(di££)  >  le-6 

del_lambda  =  del_lambda  +  di££; 
gamma  =  acos  (sin(alpha) -'cos  (del_lambda)  )  ; 
del_nu  =  acos (cot (gamma) *cot (alpha) ) ; 
nu_guess2  =  nu_guess  -  del_nu; 


167 


90 

91 

92 

93 

94 

95 

96 

97 

98 

99 

100 

101 

102 

103 

104 

105 

106 

107 

108 

109 

110 

111 

112 

113 

114 

115 

116 

117 

118 

119 


if  nu_guess2  <  0 

nu_guess2  =  nu_guess2  +  2*pi; 

end 

delt  =  TOF_£rom_nu (a , ecc , nu_guess2 , nu_guess  ,  0) ; 
t_guess  =  t_exit  -  delt; 

[R_guess , V_guess]  =  C0E2RV (a , ecc , inc , RAAN , omega , nu_guess2 )  ; 
[lat_guess , long_guess]  =  I JK_to_LATL0NG (R_guess (1) , R_guess (2) , 
R_guess (3) , GMSTQ , t_guess) ; 
if  longlim(2)  <  0 

long_guess_temp  =  long_guess; 
if  long_guess  <  0 

long_guess_temp  =  2*pi  +  long_guess; 

end 

diff  =  long_guess_temp  - longlim_temp ; 

%  plot ( (long_guess) *  180/pi , lat_guess* 180/pi , ’ bO ’ ) 

else 

diff  =  long_guess  -longlim(2); 

%  plot (long_guess  *  180/pi , lat_guess  *  180/pi , ’ kX  * ) 

end 


end 


t_exit  =  t_guess ; 

nu_exit  =  nu_guess2 ; 

R_exit  =  R_guess; 

V_exit  =  V_guess; 
lat_exit  =  lat_guess; 
long_exit  =  long_guess; 
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D.1.1. 7  Convert  Inertial  State  into  Latitude  and  Longitude 

function  [lat , long , GUST]  =  I JK_to_LATLONG (x , y , z , GUST® , t) 

global  OmegaEarth 

r  =  sqrt  (x''2  +  y“2  +  z''2)  ; 

alpha  =  atan2Cy,x); 

GUST  =  GMST8  +  OmegaEarth*t ; 

if  GUST  >=  2*pi 

GMST  =  GMST-2*pi; 

end 

long  =  alpha  -  GMST ; 

if  long  <=  -pi 

long  =  2*pi+long; 
elseif  long  >=  pi 

long  =  -2*pi+long; 

end 


lat  =  asinCz/r)  ; 

D.1.2  Single  Pass  RTM  PSO  Algorithm 

function  [ JGmin ,Jpbest,gbest,x,k, preburn_ state l,initial_target]  = 

PSO_RTM_analytical_prec (n, limits ,prec ,iter , swarm ,rfl,vfl,ae,be, Rmax , 
Rmin , latlim , longlim , tf 1) 

%Author :  Dan  Showalter  18  Oct  2812 
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%Purpose :  Utilize  PSO  to  solve  multi -orbit  sinegle  burn  maneuver  problem 


%generic  PSO  variable 
%  n:  #  of  design  variables 

%  limits:  bounds  on  design  variables  (n  x  2  vector)  with  first  element 
%  in  row  n  being  lower  bound  for  element  n  and  2nd  element  in  row 

n  being 

%  upper  bound  for  element  n 

%  iter:  number  of  iterations 

%  swarm:  swarm  size 

%  prec :  defines  the  number  of  decimal  places  to  keep  for  each  design 
%  variable  and  the  cost  function  evalution  size:  Cn+1,1) 


%Problem  specific  PSO  variables 
%  n  =  4 

%  nl  =  TOFl  =  TOP  of  first  maneuver 

%  n2  =  thetal  =  location  on  exclusion  ellipse  where  spacecraft 

will 

%  arrive  upon  completion  of  maneuver  1 

%  n3  =  T0F2  =  TOF  of  2nd  maneuver 

%  n4  =  theta2  =  location  on  exclusion  ellipse  where  spacecraft 


will 


arrive  upon  completion  of  maneuver  2 


%Specific  Problem 
%  rfl:  expected 
%  vfl:  expected 
%  ae :  semimajor 
%  be :  semiminor 
%  Rmax :  maximum 


Variables 


position 

vector 

when  spacecraft 

enters 

exclusion  zone 

velocity 

vector 

when  spacecraft 

enters 

exclusion  zone 

axis  of 

exclusi 

on  ellipse 

axis  of  exclusion  ellipse 

allowable  distance  from  Earth  (constraint  on  maneuvers 


) 
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% 


Rmin:  minimum  alowable  distance  from  Earth  (constraint  on  maneuvers) 


%  latlim:  vector  defining  latitude  bounds  on  exclusion  zone 
%  longlim:  vector  defining  longitude  bounds  on  exclusion  zone 
%  end  time  of  maneuver  sequence 

%% 

[N,M]  =  size (limits) ; 

Him  =  limits  (  :  ,  1)  I 
ulim  =  limits ( : , 2) ; 

if  N“=n 

fprintf (’ Error !  limits  size  does  not  match  number  of  variables’) 
stop 

end 

gbest  =  zeros(n,l); 

X  =  zeros (n , swarm) ; 

V  =  zeros (n , swarm) ; 
pbest  =  zeros (n , swarm) ; 

Jpbest  =  zeros (swarm  ,  1)  ; 
d  =  (ulim  -  Him)  ; 

JG  =  zeros  (iter  ,  1)  ; 

J  =  zeros (swarm  ,  1)  ; 

count  =  0; 

IND  =  0; 

CoreNum  =  6; 

if  (matlabpool ( ’ size ’ ) ) <=0 
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matlabpool ( ’ open ’ , ’local ’ , CoreNum) ; 

else 

disp (’ Parallel  Computing  Enabled ’ ) 

end 

%loop  until  maximum  iteration  have  been  met 
for  k  =  1 : iter 

%create  particles  dictated  by  swarm  size  input 


%  if  this  is  the  first  iteration 
if  k  ==  1 

for  h  =  1 : swarm 

X  (  :  ,  h)  =  random  (  ’  unif  ’  ,  Him  ,  ulim  ,  [n  ,  1]  )  I 
V ( : , h)  =  random ( ’ unif ’ ,-d,d,[n,l]); 

end 

%if  this  is  after  the  first  iteration,  update  velocity  and 
position 

%of  each  particle  in  the  swarm 

else 

parfor  h  =  1: swarm 

%set  random  weighting  for  each  component 
cl  =  2.1; 
c2  =  2.1; 
phi  =  cl+c2; 

ci  =  2/abs(2-phi  -  sqrt(phi''2  -  4*phi)); 

%  ci  =  (S).7/(n-l)*k  +  (1.2  -  0 . 7/ (n- 1)  )  ; 

cc  =  cl*random( ’ unif ’  ,  Q  ,  1) ; 
cs  =  c2*random( ’unif ’  ,0 , 1) ; 
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vdum  =  v( : , h) : 
% 


% 


if  h  "=  IND 


% 


vdum  =  v( : , h) ; 


% 


else 


% 


vdum  =  Q ; 


% 


end 


%update  velocity 

vdum  =  ci*(vdum  +  cc* (pbest ( : , h)  -  xC:,h))  +  cs*Cgbest  -  x 


(: ,h))) ; 


%check  to  make  sure  velocity  doesn’t  exceed  max  velocity  for 
each 
%variable 
for  w  =  l:n 

%if  the  variable  velocity  is  less  than  the  min,  set  it 
to  the  min 
if  vdum(w)  <  -d(w) 
vdumCw)  =  -d(w) ; 

%if  the  variable  velocity  is  more  than  the  max,  set 


it  to  the  max 


elseif  vdum(w)  >  d(w) ; 
vdumCw)  =  d(w) ; 

end 

end 

vC : , h)  =  vdum ; 
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%update  position 
xdum  =  x(:,h)  +  v(:,h); 

for  r  =  l:n 

%i£  particle  has  passed  lower  limit 
if  xdum(r)  <  llim(r) 
xdum(r)  =  llim(r) ; 

elseif  xdumCr)  >  ulim(r) 
xdum(r)  =  ulim(r) ; 

end 

X ( : , h)  =  xdum ; 


end 


end 


end 

%  round  variables  to  get  finite  precision 
for  aa  =  l:n 

X  (aa  ,  :  )  =  round  (x  (aa  ,  :)*10''(prec(aa)))/10''precCaa)  ; 
v(aa  ,  :  )  =  round  (v(aa  ,  :)*10''(prec(aa)))/lQ''precCaa)  ; 

end 


%%  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  ^  Q  5  ^  Function 


parfor  m  =  1 : swarm 

%  *  *  *  *  *  *  **********  ^  Q  5  ^  function  evaluation  here 
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[r®  1  ,  vOl  ,  rti  jkl  ,  vti  jkl  ,  manDVl  ,  DVlvec  ,  rmissl  ]  = 

Single_Burn_Maneuver (r£l , v£l , x (1 , m) , x (2 , m) , ae , be) ; 

[Ral , Rpl]  =  Ra_Rp_£rom_RV (rOl , vQl+DVlvec ’ ) ; 

i£  Ral  >  Rmax 
J  Cm)  =  In£ ; 
elsei£  Rpl  <  Rmin 
J (m)  =  In£ ; 

else 

3  Cm)  =  manDVl ; 

end 


end 


*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *******  c  o  n  s  t  r  a i n t  Equations 


%% 


%% 


%round  cost  to  nearest  precision  required 
3  -  roundC J *  1® " prec Cn+1) ) /lO" prec Cn+1) ; 

i£  k  ==  1 


Jpbest Cl : swarm)  =  J Cl: swarm); 
pbest  C :  , 1 : swarm)  =  x  C :  , 1 : swarm) ; 

[Jgbest,IND]  =  min C Jpbest C :)) ; 
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gbest ( : )  =  x( : , IND) ; 


else 


for  h=l : swarm 

if  J (h)  <  Jpbest(h) 

Jpbest (h)  =  J (h) ; 
pbest(: ,h)  =  x(: ,h) ; 
if  Jpbest(h)  <  Jgbest 


Jgbest  =  JpbestCh): 
gbest(:)  =  x(: ,h) ; 
IND  =  h; 


end 

end 


end 

end 


count  =  0; 


for  y  =  1 : swarm 


diff  =  Jgbest  -  Jpbest(y); 


if  abs (diff ) <le - 10 
count  =  count+1; 

end 


end 
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JG(k)  =  Jgbest ; 
manDV  =  Jgbest ; 
JGmin  =  Jgbest ; 

if  count  ==  swarm 
break 

end 


figure  (1) 

plot(x(l  ,:),x(2,:),’x’  ,gbest(l)  ,gbest(2)  ,  ’  rO  *  ) 
axis ( [llimCl)  ulim(l)  llim(2)  ulim(2)]) 


end 

TOFl  =  gbest(l)  ; 
thetal  =  gbest  (2)  ; 


[r01 , vOl , rti jkl , vti jkl , manDV 1 , DVlvec , rmiss 1]  =  Single_Burn_Maneuver (rf 1 , 
vfl,gbest(l), gbest (2) , ae , be) ; 


initial_target  =  [rtijkl;vtijkl; rmiss 1] ; 
preburn_statel  =  [r01 ; v01 ; tf 1 -TOFl ; DVlvec  ’  ] ; 


%  figure 

%  plot (1 : iter , JG) 

%  titleC’Cost  vs.  Iteration  #’) 
%  xlabelC’#  iterations’) 

%  ylabel ( ’ cost  ’  ) 

%  grid 
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%  axis  square 


D.1.3  Single  Burn  Maneuver 

function  [r® , vO , rti jk , vti jk , manDV , DVlvec , rmiss]  =  Single_Burn_Maneuver ( 
r£ , v£ , TOP , theta , ae , be) 

%UNTITLED2  Summary  of  this  function  goes  here 
%  Detailed  explanation  goes  here 
wgs84data ; 

global  Small  MU 

%%  determine  orbit  elements  at  spacecraft  entrance  into  exclusion  zone 
[a , ecc , inc , RAAN , w , nu]  =  RV2C0E (r£ , v£) ; 

%determine  position  vector  of  new  arrival  location 
h  =  cross (rf , v£) ; 

hunit  =  h/norm(h); 

vunit  =  v£/norm(v£) ; 

gunit  =  cross (vunit , hunit ) ; 

re  =  ae*be/sqrt CCbe*cos (theta) ) ”2  +  (ae*sin(theta)) "2) ; 

rtijk  =  rf  +  re -'Cos  (theta) '-vunit  +  re''sin(theta) '-gunit ; 

rmiss  =  norm(rtijk  -  rf) ; 


%%  determine  orbital  elements/position  vector  of  departure  location 
[nuO]  =  nu£_from_T0F (nu , -TOP , a , ecc) ; 
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[r®  ,  vQ]  =  C0E2RV  (a  ,  ecc  ,  inc  ,  RAAN  ,  w  ,  nuO)  ; 


%%  solve  lambert’s  problem  both  ways 

[Vis,  V2s,  extremal_distances_s ,  exit£lag_s]  =  lambert2 (r® * , rti jk ’ , TOP 
/(36®®*24) ,® ,MU) ; 

[Vll ,  V21 ,  extremal_distances_l ,  exit£lag_l]  =  lambert2 (r® * , rti jk ’ , -TOP 
/(36®®*24) ,® ,MU) ; 

DVS  =  normCVls  -  v® ’ ) ; 

DVL  =  normCVll  -  v® ’ ) ; 

i£  DVL  <  DVS 

manDV  =  DVL; 

DVlvec  =  Vll  -  V®  ^ 
vtijk  =  V21 ’ ; 

else 

manDV  =  DVS; 

DVlvec  =  Vis  -  V®  * ; 
vtijk  =  V2s ’ ; 


end 

D,l,4  Lambert  Targeting  Algorithm 
Code  provided  by  [41]. 

D.1.5  Position  and  Velocity  Vectors  from  Classical  Orbital  Elements 

£unction  [Rijk,Vijk]  =  C0E2RV (a , ecc , inc  ,  RAAN  ,  w  ,  nu) 


179 


2 

3 

4 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 

31 


%Author :  Dan  Showalter  18  Oct  2012 


%Purpose:  find  inertial  position  and  velocity  vector  gievn  classical 
%orbital  elements 

%%  Algorithm 

MU  =  398600.5; 

%£ind  magnitude  of  position  vector 
p  =  a*(l-ecc''2)  ; 

r  =  p/(l  +  ecc''cos(nu)); 

Rpqw  =  r '' [cos  (nu)  ;  sinCnu)  ;  0]  ; 

Vpqw  =  sqrt  CMU/p)''[-sin(nu)  ;(ecc  +  cos(nu))  ;0]  ; 

ROT  =  [cos (RAAN) *cos (w) -  sin (RAAN) *  sin (w) *cos (inc) , -cos (RAAN) *sin (w) -sin( 
RAAN)  *cos  (w)  ''cos  (inc)  ,  sin  (RAAN)  *  sin  (  inc)  ;  .  .  . 

sin  (RAAN)  *cos  (w)  +  cos  (RAAN)  *  sin  (w)  ''cos  (inc)  ,  -  sin  (RAAN)  *sin(w)  + 
cos(RAAN)*cos(w) ''cos(inc)  ,  -  cos  (RAAN)  *  sin  (inc)  ;  .  .  . 
sin(w)*sin(inc) ,cos (w) *  sin (inc) , cos (inc) ] ; 


Rijk  =  R0T*Rpqw; 
Vijk  =  R0T*Vpqw; 
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end 


D,l,6  Kepler^s  Equation 

function  [nuf]  =  nuf_£roin_T0F  (nu0  ,  TOP  ,  a  ,  e) 

%This  function  computes  the  final  true  anomaly  based  on  the  initial  trua 
%anomaly  and  the  time  of  flight 


%INPUTS 

%  a  =  semi -major  axis  (km) 

%  nuO  =  initial  true  anomaly  (rad) 

%  TOP  =  Time  of  flight  (sec) 

%  e  =  eccentricity  (unitless) 

%0UTPUTS 

%  nuf  =  final  true  anomaly  (rad) 

%GL0BALS 

%  MU  =  Earth’s  gravitational  parameter  (km^S/sec^Z) 

%INTERNALS 

%  n  =  mean  motion  (rad/sec) 

%  E0  =  initial  eccentric  anomaly  (rad) 

%  MO  =  initial  mean  anomaly  (rad) 

%  Mf  =  final  mean  anomaly  (rad) 

%  Ef  =  final  eccentric  anomaly  (rad) 

%  Eg  =  guess  for  final  eccentric  anomaly  (rad) 

global  MU 

%%  1)  compute  orbital  mean  motion 
n  =  sqrt  (MU/a''3)  ; 
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%%  2)  convert  initial  true  anomaly  to  initial  mean  anomaly 


i£  nuO  ==  0; 

M0  =  0; 

elseif  nu0  ==  pi 
M0  =  pi  ; 

else 

E0  =  acos((e  +  cos  Cnu0) ) / ( l  +  e*cos (nu0) ) ) ; 
if  (nu0  >  pi) 

E0  =  2*pi  -  E0 ; 

end 

M0  =  E0  -  e*sin(E0); 

end 

%%  3)  compute  final  mean  anomaly 
M£  =  M0  +  n*T0F; 
while  M£  >  2*pi 
M£  =  M£  -  2*pi ; 

end 

if  M£  <  0 

Mf  =  2"pi  +  M£; 

end 

Eg  =  M£; 

Ef  =  Eg  +  (Mf  -  Eg  +  e*  sin  (Eg) )  /  ( 1  -  e-'cosCEg)); 

while  Cabs(E£-Eg)  >  le-12) 

Eg  =  E£; 

E£  =  Eg  +  (Mf  -  Eg  +  e*sin(Eg))/(l  -  e''cos(Eg)); 

end 
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nu£  =  acos ( (cos (E£) -e)/(l-e*cosCE£))) ; 
i£  E£  >  pi 

nu£  =  2*pi  -  nu£ ; 

end 

D,1.7  Determine  Perigee  and  Apogee  Radii  from  Position  and  Velocity  Vectors 

£unction  [Ra,Rp]  =  Ra_Rp_£rom_RV  (rvec  ,  wee) 

%rvec  =  position  vector  km 
%vvec  =  velocity  vector  km/s 

%Ra  =  radius  o£  apogee 
%Rp  =  radius  o£  perigee 

global  MU 

%magnitudes  o£  r  and  v 
R  =  norm(rvec) ; 

V  =  norm(vvec) ; 

%speci£ic  mechanical  energy 
E  =  V''2/2  -  MU/R; 

%semimajor  axis  £rom  specir£ic  mechanical  energy 
a  =  -MU/(2'"E); 

%speci£ic  angular  momentum  vector  £rom  rvec  and  wee 
h  =  cross  (rvec  ,  wee)  ; 

%magnitude  o£  speci£ic  angular  momentum  vector 
H  =  norm(h) ; 
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%eccectricity 

e  =  sqrtCl  +  2*E*H''2/MU''2)  ; 


Ra  =  a*(l+e); 
Rp  =  a*(l-e)  : 


end 

D.2  Double  Pass  RTMs 

D.2.1  Double  Pass  RTM  Data  Script 

t®  =  8; 

GMST8  =  8; 

latlim  =  [-18  18]*pi/188; 
longlim  =  [-58  -18]*pi/188; 


wgs84data 
global  MU 

r8vec  =  [6888  7388;®  8;8  8]; 

v8vec  =  [8  8;  5 .41376581448788  sqrt (MU/7  388) /sqrt (2)  ;  5 . 4 1 3 76 5 8 1448788 
sqrt(MU/7388)/sqrtC2) ] ; 
r8  =  6888*  [1  8  8] ; 

v8  =  sqrt CMU/6888) /sqrt (2) *  [8  1  1]; 


swarm  = 

38; 

iter  = 

1888; 

aevec  = 

[58  68 

78  88  98 

188 

118  128  138 

bevec  = 

[5  6  7 

8  9  18  11 

12 

13  14  15]; 

Rmaxvec 

=  [6858 

7358]  ; 

Rminvec 

=  [6758 

7258]  ; 

prec  = 

[2;5;2;5;16]; 
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for  k 


=  1:2 


rQ  =  rOvec  (  :  , k) ; 
v0  =  vOvec  (  :  , k) ; 

Rmax  =  Rmaxvec(k); 

Rmin  =  Rminvec(k); 

[a  ,  ecc  ,  inc  ,  RAAN  ,  w  ,  nuQ]  =  RV2C0E  (rQ  ,  vO)  ; 
period  =  2*pi*sqrt(a''3/MU)  ; 

stateO= [rO  vQ] ; 

fprintfCfid , ’ \n\n\n\r  %s  %3i\r\n ’ , ’ rO= * , norm(r0) ) ; 

for  aa  =  1:11 


ae  =  aevec (aa)  ; 
be  =  bevec (aa)  ; 


fprintf (fid , ’ \n\n\n\r  %s  %3i\r\n ’ , ’ swarm= ’ , swarm)  ; 
fprintf(fid,  *%s  %3i\r\n’ , *ae=’ ,ae) ; 
fprintf (fid , * %s  %3i\r\n * , * be= ’ , be) ; 
fprintf (fid , *  %s  %3i\r\n ’ , *  maxi ter =  * , iter ) ; 
fprintf (fid ,* %2 s  %10s  %8s  %8s  %8s  %8s  %8s  %8s  %8s 
#’ , ’T1 ’  ,  ’ theta  1 ’  ,  ’T2 ’ , ’theta2 ’  , ’ DVl ’ , ’ DV2 ’ , ’ J  * , 


%8s\r\n ’ , ’ run 
’ iterations ’ , 


’Run  Time ’) ; 


itn  =  zeros (20,1); 
rt  =  zeros  (20 , 1)  ; 
tot_time  =  0; 

for  h  =  1:20 
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clear  JG  Jpbest  gbest  manDV 
tstart  =  tic; 

[r£l , v£l , t£l , lat_enter , long_enter , R_exit , V_exit ,  t_exit , 
lat_exit , long_exit]  =  zone_entry_exit2 (rO , vO , GMSTQ , tO , 
latlim , longlim) ; 

[  JG , Jpbest , gbest , x , iter_needed , preburn_state 1 , 

initial_targetl , preburn_state2 , ini tial_target2 ]  = 
PS0_2pass_RTM_analytical_prec  (4  ,  [  1200  period  ;  0  2 -'pi  ;  1200 
period;0  2*  pi],  prec  ,  iter  ,  swarm  ,  r£l  ,  v£l  ,  ae  ,  be  ,  Rmax  ,  Rmin  , 
latlim  ,  longlim  ,  t£l)  ; 

tend  =  toc(tstart) 

DVl  =  norm(preburn_state 1(8:10) *10 00)  ; 

DV2  =  norm(preburn_state2 (8:10) *10 00) ; 
manDV  =  round( JG* 1000* 10" 5) /lO" 5 ; 
itn(h)  =  iter_needed; 
rt(h)  =  tend; 

i£  h  ==  1 

minDV  =  manDV ; 
mincount  =  1; 
elsei£  manDV  <  minDV 
minDV  =  manDV ; 
mincount  =  1; 
elsei£  manDV  ==  minDV 

mincount  =  mincount  +  1; 

end 
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end 


fprint£(£id,  ’%2i  %1(S).2£  %8.5£  %10.2£  %8.5£  %10.5£  %10.5£ 
%10.5£  %4i  %10. 4£\r\n ’ ,h,gbestCl) ,gbest(2) ,gbest(3) , 
gbest(4) ,DV1 ,DV2 , manDV , itn(h) ,rt(h)) ; 


gpercent  =  inincount/h*100 ; 


tot_time  =  tot_time  +  suin(rt)  ; 
mintime  =  min(rt); 
maxtime  =  max(rt); 
meantime  =  mean(rt); 

miniter  =  min(itn); 
maxiter  =  max(itn); 
meaniter  =  mean(itn); 


fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’min 

time= ’ 

, mintime) ; 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’max 

time= ’ 

, maxtime)  ; 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’  avg 

time= ’ 

, meantime) 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’min 

iter= ’ 

, miniter)  ; 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’max 

iter= ’ 

, maxiter)  ; 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’  avg 

iter= ’ 

, meaniter) 

fprintf (fid , 

’%s 

%i\r\n ’ , ’ global 

conv= ’ 

, gpercent) 

end 

£print£C£id , ’ \n\n\n\r  %s ’ , ’ 


end 


D,2.2  Double  Pass  RTM  PSO  Algorithm 
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function  [ JGmin , Jpbest , gbest , x , k , preburn_ state  1 , initial_target 1 , 

preburn_state2 , initial_target2 ]  =  PS0_2pass_RTM_analytical_prec (n , 
limits , prec , iter , swarm , r£l , v£l , ae , be , Rmax , Rmin , latlim , longlim , t£l) 


[N,M]  =  size (limits) ; 


Him  = 

limits ( : 

,1) 

ulim  = 

limits ( : 

,2) 

if  N“=n 

fprintfC ’ Error !  limits  size  does  not  match  number  of  variables’) 
stop 

end 

gbest  =  zerosCn,!); 

X  =  zeros (n , swarm) ; 

V  =  zeros (n , swarm) ; 
pbest  =  zeros (n , swarm) ; 

Jpbest  =  zeros (swarm  ,  1)  ; 
d  =  (ulim  -  Him)  ; 

JG  =  zeros  (iter  ,  1)  ; 

J  =  zeros (swarm  ,  1)  ; 

count  =  0; 

IND  =  Q; 

CoreNum  =  12 ; 

if  (matlabpool ( ’ size ’ ) ) <=® 

matlabpool ( ’ open ’ , ’local ’ , CoreNum) ; 

else 

disp (’ Parallel  Computing  Enabled ’ ) 
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end 


%loop  until  maximum  iteration  have  been  met 
for  k  =  1 : iter 

%create  particles  dictated  by  swarm  size  input 
parfor  h  =  1 : swarm 

%  if  this  is  the  first  iteration 
if  k  ==  1 

X  (  :  ,  h)  =  random  (  ’  unif  *  ,  Him  ,  ulim  ,  [n  ,  1]  )  I 
V ( : , h)  =  random ( ’ unif  * ,-d,d,[n,l]); 


%if  this  is  after  the  first  iteration,  update  velocity  and 
position 

%of  each  particle  in  the  swarm 

else 


%set  random  weighting  for  each  component 
cl  =  2.1; 
c2  =  2.1; 
phi  =  cl+c2 ; 

ci  =  2/abs(2-phi  -  sqrt(phi''2  -  4*phi)); 

%  ci  =  (S).7/(n-l)*k  +  (1.2  -  Q  .  7/ (n- 1)  )  ; 

cc  =  cl*random( ’ unif *  ,  Q  ,  1) ; 
cs  =  c2*random( ’unif *  ,0 , 1) ; 


vdum  =  v( : , h) ; 


% 


% 


if  h  “=  IND 
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% 


vdum  =  v( : , h) ; 


% 


else 


% 


vdum  =  8 ; 


% 


end 


%update  velocity 

vdum  =  ci*(vdum  +  cc* (pbest ( : , h)  -  x(:,h))  +  cs*(gbest  -  x 


(:  ,h)))  ; 


%check  to  make  sure  velocity  doesn’t  exceed  max  velocity  for 
each 
%variable 
for  w  =  l:n 

%if  the  variable  velocity  is  less  than  the  min,  set  it 
to  the  min 
if  vdum(w)  <  -d(w) 
vdum(w)  =  -d(w) ; 

%if  the  variable  velocity  is  more  than  the  max,  set 


it  to  the  max 


elseif  vdum(w)  >  d(w) ; 
vdum(w)  =  d(w) ; 

end 

end 

V ( : , h)  =  vdum ; 

%update  position 
xdum  =  x(:,h)  +  v(:,h); 

for  r  =  l:n 
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%i£  particle  has  passed  lower  limit 
if  xdum(r)  <  llimCr) 


xdum(r)  =  llim(r) ; 

elseif  xdumCr)  >  ulim(r) 
xdum(r)  =  ulim(r) ; 

end 

X  C :  , h)  =  xdum ; 


end 


end 


end 

%  round  variables  to  get  finite  precision 
for  aa  =  l:n 

X  (aa  ,  :  )  =  round  (x  (aa  ,  :)*10''(prec(aa)))/lO''precCaa)  ; 
v(aa  ,  :  )  =  round  (v(aa  ,  :)*10''(prec(aa)))/lQ''prec(aa)  ; 

end 

%%  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  '*'***^(351-  Function 


parfor  m  =  1 : swarm 

%  *  *  *  *  *  *  **********  ^  Q  5  ^  function  evaluation  here 


OmegaEarth=0. 000072 92 115 1467 ; 

[r01 , V01 , rti jkl , vti jkl , manDVl , DVlvec , rmissl ]  = 

Single_Burn_Maneuver (rf 1 , v£l , x (1 , m) , x (2 , m) , ae , be) ; 

[Ral , Rpl]  =  Ra_Rp_£rom_RV  Cr01 , v01+DVlvec ’ ) ; 
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if  Ral  >  Rmax 


3  Cm)  =  Inf ; 
elseif  Rpl  <  Rmin 
3 (m)  =  Inf ; 

else 


[rf2  ,  vf2  ,  tf2  ,  lat_enter2  ,  long_enter2  ,  R_exit2  ,  V_exit2  ,  t_exit2  , 
lat_exit2 , long_exit2 ]  =  zone_entry_exit2 (rtijkl ,vtijkl 
, O+OmegaEarth* tf 1 , 0 , latlim , longlim) ; 

[r02 , v02 , rti jk2 , vti jk2 , manDV2 , DV2vec , rmiss2 ]  = 

Single_Burn_Maneuver (rf2 , vf2 ,x(3,m) ,x(4,m) ,ae,be) ; 

[Ra2 ,Rp2]  =  Ra_Rp_from_RV (r®2 ,v02+DV2vec  *) ; 

if  Ra2  >  Rmax 
3 (m)  =  Inf ; 
elseif  Rp2  <  Rmin 
J (m)  =  Inf; 

else 

J (m)  =  manDVl  +  manDV2 ; 

end 

end 


end 


*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *******  c  o  n  s  t  r  a i n t  Equations 
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%% 


%% 


%round  cost  to  nearest  precision  required 
J  =  round( J *  IQ" prec (n+1) ) /lO" prec (n+1) ; 

if  k  ==  1 


Jpbest (1 ; swarm)  =  J(l: swarm); 
pbest  (  :  , 1 : swarm)  =  x ( :  , 1 : swarm) ; 

[Jgbest,IND]  =  min ( Jpbest  (:)) ; 

gbest  (:)  =  x(:  , IND) ; 


else 


for  h=l : swarm 

if  J (h)  <  Jpbest(h) 


JpbestCh)  = 

J(h)  ; 

pbest ( : , h)  = 

x(: ,h) : 

if  Jpbest(h) 

<  Jgbest 

Jgbest  = 

Jpbest (h) 

gbest ( : ) 

II 

><1 

IND  =  h; 

end 

end 

end 


193 


175 

176 

177 

178 

179 

180 

181 

182 

183 

184 

185 

186 

187 

188 

189 

190 

191 

192 

193 

194 

195 

196 

197 

198 

199 

200 

201 

202 

203 

204 

205 


end 


count  =  0; 

for  y  =  1 : swarm 

di££  =  Jgbest  -  Jpbest(y); 

if  abs(di££)<le-10 
count  =  count+1; 

end 

end 

JG(k)  =  Jgbest ; 
manDV  =  Jgbest ; 

JGmin  =  Jgbest ; 

if  count  ==  swarm 
break 

end 

end 

OmegaEarth^O.000072921151467 ; 

TOFl  =  gbest(l)  ; 
thetal  =  gbest  (2)  ; 

T0F2  =  gbest(3)  ; 
theta2  =  gbest(4); 


[r01 , V01 , rti jkl , vti jkl , manDV 1 , DVlvec , rmissl]  =  Single_Burn_Maneuver (rfl , 
v£l,gbest(l) , gbest (2) , ae , be) ; 
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[r£2  ,  v£2  ,  t£2  ,  lat_enter2  ,  long_enter2  ,  R_exit2  ,  V_exit2  ,  t_exit2  ,  lat_exit2  , 
long_exit2  ]  =  zone_entry_exit2  (rtijkl  ,vtijkl  ,  0+OmegaEarth''t£l  ,  ®  , 
latlim , longlim) ; 

[r02 , v02 , rti jk2 , vti jk2 , manDV2 , DV2vec , rmiss2 ]  =  Single_Burn_Maneuver (r£2 , 
v£2 , gbest (3) , gbest (4) , ae , be) ; 


ini tial_target 1  =  [rtijkl;vtijkl; rmissl]  ; 
preburn_statel  =  [rOl ; v01 ; t£l -TOFl ; DVlvec  ’  ] ; 
ini tial_target2  =  [rti jk2 ; vti jk2 ; rmiss2] ; 
preburn_state2  =  [r02 ; v02 ; t£2 -TOF2 ; DV2vec  ’  ] ; 


%  Figure 

%  plot (1 : iter , JG) 

%  titleC’Cost  vs.  Iteration  #’) 

%  xlabelC’#  iterations*) 

%  ylabel  (  ’ cost  ’  ) 

%  grid 

%  axis  square 

D.3  Triple  Pass  RTMs 

D.3.1  Triple  Pass  RTM  Data  Script 

t®  =  8; 

GMST8  =  8; 

latlim  =  [-18  18]*pi/188; 
longlim  =  [-58  -18]*pi/188; 

wgs84data 
global  MU 

r8vec  =  [6888  7388:8  8;8  8]; 
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vOvec 


[0  0:5.41376581448788  sqrt (MU/7300) /sqrt (2) ; 5 . 4 1 3 76 5 8 1448788 


sqrt (MU/7300) /sqrt (2) ] ; 


rO  =  6800"  [1  0  0] ; 

vO  =  sqrt (MU/6800) /sqrt (2) *  [0  1  1] ; 


swarm  = 

6®; 

iter  = 

10®0; 

aevec  = 

[5® 

6® 

7® 

8® 

98 

IQ® 

11®  12®  13® 

bevec  = 

[5  6 

7 

8  9 

1® 

11 

12 

13  14  15]; 

Rmaxvec 

=  [685® 

73 

5®] 

» 

Rminvec 

=  [675® 

72 

5®] 

» 

prec  = 

[2;5; 

2;5 

:2; 

5;i 

6] : 

mincase i 

CD  = 

4; 

mincase i 

C2)  = 

1; 

for  k  =  2  :  2 

rO  =  rOvec  (  :  , k) ; 
vO  =  vOvec ( : , k) ; 

Rmax  =  Rmaxvec(k); 

Rmin  =  Rminvec(k); 

[a  ,  ecc  ,  inc  ,  RAAN  ,  w  ,  nuO]  =  RV2C0E  (rO  ,  vO)  ; 
period  =  2*pi*sqrt(a''3/MU)  ; 

stateO= [rO  vO] ; 

£print£(£id , ’ \n\n\n\r  %s  %3i\r\n ’ , ’ rO= * , norm(rO) ) ; 

for  aa  =  8:8 
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ae  =  aevec (aa) ; 
be  =  bevec (aa) ; 

fprintf (fid , ’ \n\n\n\r  %s  %3i\r\n swarm= swarm) ; 

£printf(fid, ’%s  %3i\r\n’ , ’ae=’ ,ae) ; 

£printf(fid, ’%s  %3i\r\n’ ,  ’be=’  ,be)  ; 
fprintf (fid , ’ %s  %3i\r\n ’ , ’ maxiter= ’ , iter ) ; 

fprintf (fid %2 s  %10s  %8s  %8s  %8s  %8s  %8s  %8s  %8s  %8s  %8s  %8s  %8 
s\r\n’ , ’run  #’ , ’T1 ’ , ’ theta  1 ’ , ’ T2 ’ , ’ theta2 ’ , ’T3 ’ , ’ theta3 ’ , ’ 

DVl ’ , ’DV2 ’ , ’DV3 ’ , ’ 3 ’ , ’ iterations ’ , ’Run  Time ’ ) ; 

itn  =  zeros  (2®  ,  1)  ; 
rt  =  zeros  (20 , 1)  ; 
tot_time  =  0; 

for  h  =  41:60 

clear  3G  Jpbest  gbest  manDV 

tstart  =  tic; 

[rfl ,v£l ,t£l , lat_enter , long_enter , R_exit , V_exit , t_exit , 
lat_exit , long_exit]  =  zone_entry_exit2 (r® , v0 , GMST0 , t® , 
latlim , longlim) ; 

[IG, Jpbest, gbest, X, iter_needed , preburn_state 1  , 

initial_targetl , preburn_state2 , initial_target2 , 
preburn_state3 , initial_target3]  =  ... 

PS0_3pass_RTiy[_analytical_prec  (6  ,  [  120®  period;®  2*pi  ;  120® 
period;®  2*pi  ;  120®  period;®  2*pi] , prec , iter , swarm , 
rfl,v£l,ae,be, Rmax , Rmin , latlim , longlim , tf 1) ; 
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tend  =  toc(tstart) 


DVl  =  norm(preburn_state 1(8:10) *10 00)  ; 

DV2  =  norm(preburn_state2  (8 : 10) *  1000) ; 

DVB  =  norm(preburn_state3  (8 : 10) *1000)  ; 
manDV  =  round( JG* 1000* 10" 5) /lO" 5 ; 
itn(h)  =  iter_needed; 
rt(h)  =  tend; 

i£  h  ==  1  I  I  h  ==  21  I  I  h  ==  41 
minDV  =  manDV ; 
mincount  =  1; 
elseif  manDV  <  minDV 
minDV  =  manDV ; 
mincount  =  1; 
elseif  manDV  ==  minDV 

mincount  =  mincount  +  1; 

end 

fprint£(£id, ’%2i  %10.2£  %8.5£  %10.2£  %8.5£  %10.2£  %8.5£ 
%10.5£  %10.5£  %10.5£  %10.5£  %4i  %10 . 4£\r\n ^ h , gbest ( 1)  , 
gbest(2)  ,gbest(3)  ,gbest(4)  ,gbestC5)  ,gbestC6)  ,DV1  ,  DV2  ,  DVB 
,  manDV  ,  itn  (h)  ,  rt  (h)  )  ; 

end 

gpercent  =  mincount /h* 100 ; 

tot_time  =  tot_time  +  sum(rt) ; 

mintime  =  min(rt); 

maxtime  =  max(rt); 

meantime  =  mean(rt); 

miniter  =  min(itn); 

maxiter  =  max(itn); 
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meaniter  =  mean(itn); 


fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’min 

time= ’ 

, mintime) ; 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’max 

time= ’ 

, maxtime) ; 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’  avg 

time= ’ 

, meantime) 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’min 

iter= ’ 

, miniter )  ; 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’max 

iter= ’ 

, maxiter )  ; 

fprintf (fid , 

’%s 

%8 

5f\r\n’ 

,  ’  avg 

iter= ’ 

, meaniter) 

fprintf (fid , 

’%s 

%i\r\n ’ , ’ global 

conv= ’ 

, gpercent) 

end 

fprintfCfid , ’ \n\n\n\r  %s’,’ 


end 

D.3.2  Triple  Pass  RTM  PSO  Algorithm 

function  [ JGmin , Jpbest , gbest , x , k , preburn_ state  1 , initial_target 1 , 

preburn_state2 , ini tial_ target 2 , preburn_state3 , initial_target3]  = 
PS0_3pass_RT]yi_analytical_prec  (n ,  limits  ,  prec  ,  iter  ,  swarm  ,  r£l ,  v£l  ,  ae  ,  be 
,  Rmax  ,  Rmin  ,  latlim  ,  longlim  ,  t£l) 

%Author :  Dan  Showalter  18  Oct  2012 

%Purpose:  Utilize  PSO  to  solve  multi -orbit  sinegle  burn  maneuver  problem 

%generic  PSO  variable 
%  n:  #  of  design  variables 

%  limits:  bounds  on  design  variables  (n  x  2  vector)  with  first  element 
%  in  row  n  being  lower  bound  for  element  n  and  2nd  element  in  row 

n  being 

%  upper  bound  for  element  n 
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40 


%  iter:  number  of  iterations 

%  swarm:  swarm  size 

%  prec :  defines  the  number  of  decimal  places  to  keep  for  each  design 
%  variable  and  the  cost  function  evalution  size:  Cn+1,1) 


%Problem  specific  PSO  variables 
%  n  =  4 

%  nl  =  TOFl  =  TOP  of  first  maneuver 

%  n2  =  thetal  =  location  on  exclusion  ellipse  where  spacecraft 

will 

%  arrive  upon  completion  of  maneuver  1 

%  n3  =  T0F2  =  TOF  of  2nd  maneuver 

%  n4  =  theta2  =  location  on  exclusion  ellipse  where  spacecraft 

will 

%  arrive  upon  completion  of  maneuver  2 


%Specific  Problem  Variables 


% 

% 

% 

% 

% 

% 

% 

% 

% 


rfl:  expected  position  vector  when  spacecraft  enters  exclusion  zone 
vfl:  expected  velocity  vector  when  spacecraft  enters  exclusion  zone 
ae :  semimajor  axis  of  exclusion  ellipse 
be:  semiminor  axis  of  exclusion  ellipse 

Rmax :  maximum  allowable  distance  from  Earth  (constraint  on  maneuvers 

) 

Rmin :  minimum  alowable  distance  from  Earth  (constraint  on  maneuvers) 
latlim:  vector  defining  latitude  bounds  on  exclusion  zone 
longlim:  vector  defining  longitude  bounds  on  exclusion  zone 
end  time  of  maneuver  sequence 


%% 
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41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 

61 

62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 


[N,M]  =  size (limits) ; 


Him  =  limits  (  :  ,  1)  I 
ulim  =  limits(:,2); 

if  N“=n 

fprintfC ’ Error !  limits  size  does  not  match  number  of  variables’) 
stop 

end 

gbest  =  zerosCn,!); 

X  =  zeros (n , swarm) ; 

V  =  zeros (n , swarm) ; 
pbest  =  zeros (n , swarm) ; 

Jpbest  =  zeros (swarm  ,  1)  ; 
d  =  (ulim  -  Him)  ; 

JG  =  zeros (iter  ,  1)  ; 

J  =  zeros (swarm , 1) ; 

count  =  0; 

IND  =  Q; 

CoreNum  =  12 ; 

if  (matlabpool ( ’ size ’ ) ) <=® 

matlabpool ( ’ open ’ , ’local ’ , CoreNum) ; 

else 

disp (’ Parallel  Computing  Enabled ’ ) 

end 

%loop  until  maximum  iteration  have  been  met 
for  k  =  1 : iter 
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%create  particles  dictated  by  swarm  size  input 


%  if  this  is  the  first  iteration 
if  k  ==  1 

for  h  =  1 : swarm 

X  (  :  ,  h)  =  random  (  ’  unif  *  ,  Him  ,  ulim  ,  [n  ,  1]  )  ; 
V ( : , h)  =  random ( ’ unif  * ,-d,d,[n,l]); 


end 


%if  this  is  after  the  first  iteration,  update  velocity  and 
position 

%of  each  particle  in  the  swarm 


else 


parfor  h  =  1: swarm 

%set  random  weighting  for  each  component 
cl  =  2.1; 
c2  =  2.1; 
phi  =  cl+c2 ; 

ci  =  2/abs(2-phi  -  sqrt(phi''2  -  4*phi)); 

%  ci  =  (S).7/(n-l)*k  +  (1.2  -  0 . 7/ (n- 1)  )  ; 

cc  =  cl*random( ’ unif *  ,  0 , 1) ; 
cs  =  c2*random( ’unif *  ,0 , 1) ; 

vdum  =  V ( : , h) ; 


% 


% 


if  h  ~=  IND 


% 


vdum  =  v( : , h) ; 


% 


else 


% 


vdum  =  0 ; 
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%  end 

%update  velocity 

vdum  =  ci*(vdum  +  cc * (pbest ( : , h)  -  xC:,h))  +  cs*(gbest  -  x 

(: ,h))) ; 


%check  to  make  sure  velocity  doesn’t  exceed  max  velocity  for 
each 
%variable 
for  w  =  l:n 

%if  the  variable  velocity  is  less  than  the  min,  set  it 
to  the  min 
if  vdum(w)  <  -d(w) 
vdum(w)  =  -d(w) ; 

%if  the  variable  velocity  is  more  than  the  max,  set 
it  to  the  max 
elseif  vdumCw)  >  d(w) ; 
vdum(w)  =  d(w) ; 

end 

end 

V ( : , h)  =  vdum ; 

%update  position 
xdum  =  x(:,h)  +  v(:,h); 

for  r  =  l:n 

%if  particle  has  passed  lower  limit 
if  xdum(r)  <  llim(r) 
xdum(r)  =  llim(r) ; 
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elseif  xdum(r)  >  ulim(r) 
xdum(r)  =  ulim(r) ; 

end 

X ( : , h)  =  xdum ; 


end 


end 


end 

%  round  variables  to  get  finite  precision 
for  aa  =  l:n 

X  (aa  ,  :  )  =  round  (x  (aa  ,  :)*10''(prec(aa)))/lQ''precCaa)  ; 
v(aa  ,  :  )  =  round  (v(aa  ,  :)*10''(prec(aa)))/lQ''precCaa)  ; 

end 

*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  c  o  s  t  Function 


parfor  m  =  1 : swarm 

%  *  *  *  *  *  *  *  *********  ^  Q  5  ^  function  evaluation  here 


OmegaEarth=0. 000072 92 115 1467 ; 

[r01 , V01 , rti jkl , vti jkl , manDVl , DVlvec , “]  =  Single_Burn_Maneuver ( 
rf 1 , vf 1 , X (1 , m) , X (2 , m) , ae , be) ; 

[Ral , Rpl]  =  Ra_Rp_from_RV (r01 , v01+DVlvec ’ ) ; 

if  Ral  >  Rmax 
J (m)  =  Inf ; 
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161  elseif  Rpl  <  Rmin 

162  3  Cm)  =  Inf ; 

163  else 

164 

165  [rf2  ,  v£2  ,  t£2  ,  ~  ~  ~  ~  ~  ~  =  zone_entry_exit2  (rti  jkl  ,  vti  jkl 

, 0+OmegaEarth*t£l ,®,latlim,longlim) ; 

166 

167  [r02  ,  V02  ,  rti  jk2  ,  Vti  jk2  ,  manDV2  ,  DV2vec  ,  ~  ]  = 

Single_Burn_Maneuver (r£2 ,v£2 ,x(3,m) ,xC4,m) ,ae,be) ; 

168 

169  [Ra2,Rp2]  =  Ra_Rp_£rom_RV(r®2  ,  v®2+DV2vec  ’  )  ; 

170 

171  if  Ra2  >  Rmax 

172  3  (m)  =  Inf ; 

173  elseif  Rp2  <  Rmin 

174  3  (m)  =  Inf ; 

175  else 

176 

177  [rf3  ,  v£3  ,  tf3  ~  =  zone_entry_exit2  (rti  jk2  , 

vti jk2 , ®+OmegaEarth*Ctf l+t£2) , ® , latlim , longlim) ; 

178 

179  [r®3  ,  v®3  ,  rti  jk3  ,  vtijk3  ,manDV3  ,  DV3vec  ,  ~]  = 

Single_Burn_Maneuver (rf 3 ,vf3,x(5,m) ,x(6,m) ,ae,be) ; 

180 

181  [Ra3,Rp3]  =  Ra_Rp_from_RV  (r®3  ,  v®3+DV3vec  ’  )  : 

182 

183  %  figure 

184  %  %  plot  (long  1  (:)*  18®/pi  ,  lat  1  (:)*  18®/pi  r  .’ ) 

185  % 

186  % 

187  %  longmin_plot  (1 :  2)  =  longlim(l)  ; 

188  %  longmax_plot  (1 :  2)  =  longlim(2)  ; 
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189  % 

190  % 

191  % 

192  % 

193  % 

194  % 

195  % 

196  % 

197  % 

198  % 

199  % 

200  % 
201  % 
202  % 

203  % 

204  % 

205  % 

206  % 

207  % 

208  % 

209  % 

210  % 

211  % 
212  % 

213 

214 


latmax_plot ( 1 : 2)  =  latlimCl) ; 
latmin_plot  ( 1 : 2)  =  latlimC2) ; 

plot (longrain_plot (:)*18Q/pi,latlimC:)* 188/pi, ’c-’) 

xlabel C ’ longitude  (deg)’) 

ylabel C ’ latitude  (deg)’) 

axis([-188  180  -90  90]) 

grid 

hold  on 

plot (longmax_plot (:)* 180/pi, latlim(:)* 180/pi, ’c-’) 
if  longliin(2)  >  longlim(l) 

plot(longlim(:)* 180/pi , latmax_plot (:)* 180/pi, ’c-’) 
plot(longlim(:)* 180/pi , latmin_plot (:)* 180/pi, ’c-’) 

else 

longliin_plot  =  [longlira(l)  pi  -pi  longlim(2)  ]  ; 
plot (long lim_plot (1:2)* 180/pi , latmax_plot ( : ) *  180/ 

pi,  ’c-’) 

plot (long lim_plot (3:4)* 180/pi , latmax_plot ( : ) *  180/ 

pi,  ’c-’) 

plot (long lim_plot (1:2)* 180/pi , latmin_plot ( : ) *  180/ 

pi,  ’c-’) 

plot (long lim_plot (3:4)* 180/pi , latmin_plot ( : ) *  180/ 

pi,  ’c-’) 

end 

plot(l ong_ent er2* 180/pi, lat_enter2* 180/pi, ’rO’  , 
long_exit2* 180/pi , lat_exit2* 180/pi  ,  ’bO  ’) 

plot(l ong_ent er3* 180/pi, la t_enter3* 180/pi, ’rO’ , 
long_exit3* 180/pi , lat_exit3* 180/pi ,  ’bO  ’) 

close  all 

if  Ra3  >  Rmax 
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J (m)  =  Inf ; 
elseif  Rp3  <  Rmin 
J (m)  =  Inf ; 

else 


J (m)  =  manDVl  +  manDV2  +  manDV3 ; 

end 

end 

end 


end 


*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *******  c  o  n  s  t  r  a i n t  Equations 


%% 


%% 


%round  cost  to  nearest  precision  required 
J  =  round( J *  IQ" prec (n+1) ) /lO" prec (n+1) ; 

if  k  ==  1 


Jpbest (1 : swarm)  =  J(l: swarm); 
pbest  (  :  , 1 : swarm)  =  x ( :  , 1 : swarm) ; 

[Jgbest,IND]  =  min( Jpbest  (:)) ; 

gbest  (:)  =  x(:  , IND) ; 


else 
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255 

256 
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for  h=l : swarm 


if  J (h)  <  Jpbest(h) 
ipbest (h)  =  J  (h)  ; 
pbest(: ,h)  =  x(: ,h) ; 
if  Jpbest(h)  <  Jgbest 

Jgbest  =  JpbestCh); 
gbest  (:)  =  x(:  ,h) ; 
IND  =  h; 


end 

end 

end 

end 

count  =  0; 

for  y  =  1 : swarm 

diff  =  Jgbest  -  Jpbest(y); 

if  abs(diff)<le-10 
count  =  count+1; 

end 

end 

JG(k)  =  Jgbest ; 
manDV  =  Jgbest ; 

JGmin  =  Jgbest ; 
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if  count 


swarm 


break 

end 

end 

OmegaEarth^Q.  00(587292  115  1467; 

TOFl  =  gbest(l)  ; 

T0F2  =  gbest(3)  ; 

T0F3  =  gbest(5)  ; 

[rOl , vOl , rti jkl , vti jkl , manDVl , DVlvec , rmiss 1]  =  Single_Burn_Maneuver (rf 1 , 
v£l,gbest(l) ,gbest(2) ,ae,be); 

[rf2 , vf2 , tf2 , lat_enter2 , long_enter2 , R_exit2 , V_exit2 , t_exit2 ,lat_exit2 , 
long_exit2]  =  zone_entry_exit2(rtijkl,vtijkl, 0+OmegaEarth*tf 1 , 0 , 
latlim , longlim) ; 

[r02 , v02 , rti jk2 , vti jk2 , manDV2 , DV2vec , rmiss2 ]  =  Single_Burn_Maneuver (rf2 , 
v£2 ,gbest(3) ,gbest(4) ,ae,be) ; 

[r£3 , v£3 , t£3 , lat_enter 3 , long_enter 3 , R_exit3 , V_exit3 , t_exit3 ,lat_exit3 , 
long_exit3]  =  zone_entry_exit2(rtijk2,vtijk2, 0+OmegaEarth*Ct£l+t£2 ) 

, 0 , latlim , longlim) ; 

[r03 , v03 , rti jk3 , vti jk3 , manDV3 , DV3vec , rmiss 3]  =  Single_Burn_Maneuver (r£3 , 
v£3  ,  gbest  (5)  ,  gbest  (6)  ,  ae  ,  be)  ; 


initial_target 1 

preburn_statel 

initial_target2 

preburn_state2 

initial_target3 


[rtijkl;vtijkl; rmissl] ; 
[rOl ; vOl :t£l- TOFl : DVlvec  ’] 
[rtijk2 ;vtijk2 ; rmiss2] ; 
[r82 ; v02 :t£2-TOF2 :DV2vec  ’] 
[rtijk3;vtijk3; rmiss 3] ; 
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preburn_state3  =  [r03 ; v03 ; t£3 -TOF3 ; DV3vec ’ ] ; 


%  figure 

%  plot (1 : iter , JG) 

%  titleC’Cost  vs.  Iteration  #’) 

%  xlabelC’#  iterations’) 

%  ylabel ( ’ cost  ’  ) 

%  grid 

%  axis  square 

D3.3  Triple  Pass  Multiple  Revolution  RTM  PSO  Algorithm 

function  [ JGmin , Jpbest , gbest , x , k , ex_f lag , J sub out ]  = 

PS0_3pass_RTM_local_nrev (n , limits , prec , iter , swarm , nhood , rf 1 , vf 1 , ae , 
be  ,  Rmax  ,  Rmin  ,  latlim  ,  longlim  ,  tf  1) 

%Author :  Dan  Showalter  18  Oct  2012 

%Purpose:  Utilize  PSO  to  solve  multi -orbit  sinegle  burn  maneuver  problem 

%generic  PSO  variable 
%  n:  #  of  design  variables 

%  limits:  bounds  on  design  variables  (n  x  2  vector)  with  first  element 
%  in  row  n  being  lower  bound  for  element  n  and  2nd  element  in  row 

n  being 

%  upper  bound  for  element  n 

%  iter:  number  of  iterations 

%  swarm:  swarm  size 

%  prec:  defines  the  number  of  decimal  places  to  keep  for  each  design 
%  variable  and  the  cost  function  evalution  size:  (n+1,1) 

%Problem  specific  PSO  variables 
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%  n  =  4 


% 

% 

% 

% 

% 


nl  =  TOFl  =  TOF  of  first  maneuver 


will 


n2 

=  thetal 

=  location 

on 

exclusion  ellipse 

where 

spacecraft 

arrive  upon 

completion 

of 

maneuver  1 

n3 

=  T0F2  = 

TOF  of  2nd 

maneuver 

n4 

=  theta2 

=  location 

on 

exclusion  ellipse 

where 

spacecraft 

will 


arrive  upon  completion  of  maneuver  2 


%Specific  Problem 
%  rfl:  expected 
%  vfl:  expected 
%  ae :  semimajor 
%  be :  semiminor 
%  Rmax :  maximum 


Variables 

position  vector  when  spacecraft  enters  exclusion  zone 
velocity  vector  when  spacecraft  enters  exclusion  zone 
axis  of  exclusion  ellipse 
axis  of  exclusion  ellipse 

allowable  distance  from  Earth  (constraint  on  maneuvers 


) 

%  Rmin :  minimum  alowable  distance  from  Earth  (constraint  on  maneuvers) 
%  latlim:  vector  defining  latitude  bounds  on  exclusion  zone 
%  longlim:  vector  defining  longitude  bounds  on  exclusion  zone 
%  end  time  of  maneuver  sequence 


%% 

[N,M]  =  size (limits) ; 


Him  = 

limits ( : 

,1) 

ulim  = 

limits ( : 

,2) 

if  N~=n 


211 


47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 

61 

62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 

74 

75 

76 

77 

78 


£print£( ’ Error !  limits  size  does  not  match  number  o£  variables’) 
stop 

end 

Ibest  =  zeros (n , swarm) ; 

X  =  zeros (n , swarm) ; 

V  =  zeros (n , swarm) ; 
pbest  =  zeros (n , swarm) ; 

Jpbest  =  zeros (swarm  ,  1)  ; 
d  =  (ulim  -  Him)  ; 

JG  =  zeros  (iter  ,  1)  ; 

J  =  zeros (swarm  ,  1)  ; 

Jsubs  =  zeros (3 , swarm) ; 

Jsubp  =  zeros (3 , swarm) ; 

Jsubout  =  zeros(l,3); 

count  =  0; 

IND  =  Q; 

CoreNum  =  12 ; 

i£  (matlabpool ( ’ size ’ ) ) <=® 

matlabpool ( ’ open ’ , ’local ’ , CoreNum) ; 

else 

disp (’ Parallel  Computing  Enabled ’ ) 

end 

%loop  until  maximum  iteration  have  been  met 
£or  k  =  1 : iter 

%create  particles  dictated  by  swarm  size  input 
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%  if  this  is  the  first  iteration 


if  k  ==  1 


for  h  =  1 : swarm 


x(:,h)  =  randomC  ’  unif  ’  ,  Him  ,  ulim  ,  [n  ,  1]  )  ; 


v(:,h)  =  randomC ’ unif -d , d , [n  ,  1] )  ; 


end 


%if  this  is  after  the  first  iteration,  update  velocity  and 
position 

%of  each  particle  in  the  swarm 


else 


parfor  h  =  1 : swarm 

%set  random  weighting  for  each  component 
cl  =  2.09; 
c2  =  2.09; 
phi  =  cl+c2; 

ci  =  2/abs(2-phi  -  sqrt(phi''2  -  4*phi))  ; 

%  ci  =  0.7/(n-l)*k  +  (1.2  -  0.7/(n-l)); 

cc  =  cl*random( ’ unif ’  ,  0 , 1)  ; 
cs  =  c2*random( ’unif ’  ,0 , 1)  ; 

vdum  =  v( : , h) ; 


% 


% 


if  h  IND 


% 


vdum  =  v( : , h) ; 


% 


else 


% 


vdum  =  0 ; 


% 


end 


%update  velocity 


213 


110 

111 

112 

113 

114 

115 

116 

117 

118 

119 

120 

121 

122 

123 

124 

125 

126 

127 

128 

129 

130 

131 

132 

133 

134 

135 

136 

137 


vdum  =  ci''(vdum  +  cc  *  (pbest  (  :  ,  h) 


x(:,h))  +  cs* ( Ibest ( : , h) 


-  x(: .h))) ; 


%check  to  make  sure  velocity  doesn’t  exceed  max  velocity  for 
each 
%variable 
for  w  =  l:n 

%if  the  variable  velocity  is  less  than  the  min,  set  it 
to  the  min 
if  vdum(w)  <  -d(w) 
vdum(w)  =  -d(w) ; 

%if  the  variable  velocity  is  more  than  the  max,  set 
it  to  the  max 
elseif  vdum(w)  >  d(w) ; 
vdum(w)  =  d(w) ; 

end 

end 

V ( : , h)  =  vdum ; 

%update  position 
xdum  =  x(:,h)  +  v(:,h); 

for  r  =  l:n 

%if  particle  has  passed  lower  limit 
if  xdum(r)  <  llimCr) 
xdum(r)  =  llim(r) ; 

elseif  xdum(r)  >  ulim(r) 
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xdumCr)  =  ulim(r) ; 


end 


X ( : , h)  =  xdum ; 


end 


end 


end 

%  round  variables  to  get  finite  precision 
for  aa  =  l:n 

X  (aa  ,  :  )  =  round  (x  (aa  ,  :)*10''(prec(aa)))/lO''precCaa)  ; 
v(aa  ,  :  )  =  round  (v(aa  ,  :)*10''(prec(aa)))/lO''precCaa)  ; 

end 

*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  'V  *  *  *  ^  Q  5 1-  Function 


parfor  m  =  1 : swarm 

^  *  *  *  *  *  *  **********  ^  Q  5  ^  function  evaluation  here 

OmegaEarth=0. 000072 92 115 1467 ; 

[r01 , V01 , rti jkl , vti jkl , manDVl , DVlvec , “]  =  Single_Burn_Maneuver ( 
rf 1 , vf 1 , X (1 , m) , X (2 , m) , ae , be) ; 

[Ral , Rpl]  =  Ra_Rp_from_RV  Cr01 , v01+DVlvec ’ ) ; 

if  Ral  >  Rmax 
3 (m)  =  Inf ; 

JsubsC:,m)  =  [ Inf ; Inf ; Inf ] ; 
elseif  Rpl  <  Rmin 
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J (m)  =  In£ ; 

JsubsC:,m)  =  [ Inf ; Inf ; Inf] ; 


[rf2  ,  v£2  ,  t£2  ,  lat_enter2  ,  long_enter2  ,  “  ,  “  ,  t2_exit  ,  lat_exit2  , 
long_exit2]  =  zone_entry_exit2  (rtijkl  ,vtijkl  ,0+ 
OmegaEarth*t£l , 0 , latlim , longlim) ; 

[r02 , V02 , rti jk2 , vti jk2 , manDV2 , DV2vec , = 

Single_Burn_Maneuver (r£2 , v£2 ,x(3,m) ,xC4,m) ,ae,be) ; 

[Ra2  ,Rp2]  =  Ra_Rp_£roin_RV (r02  ,v02+DV2vec  *)  ; 

if  Ra2  >  Rmax 
J (m)  =  Inf ; 

Jsubs(:,m)  =  [manDVl ; Inf ; Inf] ; 
elseif  Rp2  <  Rmin 
J (m)  =  Inf ; 

isubs(:,m)  =  [manDVl ; Inf ; Inf ] ; 


[r£3 , v£3 , t£3 , lat_enter3 , long_enter3 lat_exit3 , 
long_exit3]  =  zone_entry_exit2 (rti jk2 ,vtijk2 ,0+ 
OmegaEarth*  Ct£l  +  t£2 ) , 0 , latlim , longlim) ; 

if  x(5,m)  >  (t£2+t£3 - C t2_exit ) ) 

J (m)  =  Inf ; 

Jsubs(:,m)  =  [manDVl ; manDV2 ; Inf ] ; 
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[r®3  ,  v03  ,  rti  jk3  ,  vti  jk3  ,  manDV3  ,  DV3vec  , 


Single_Burn_Maneuver_nrev  Cr£3 , v£3 , x (5 , m) , x (6 , m) , 
ae ,be)  ; 

[Ra3 , Rp3]  =  Ra_Rp_£rom_RV (r03 , v®3+DV3vec ’ ) ; 

i£  Ra3  >  Rmax 
3 (m)  =  In£ ; 

Jsubs(:,m)  =  [manDVl ; manDV2 ; In£] ; 
elsei£  Rp3  <  Rmin 
3 (m)  =  In£ ; 

Jsubs(:,m)  =  [manDVl ; manDV2 ; In£] ; 

else 


J (m)  =  manDVl  +  manDV2  +  manDV3; 

3  subs ( :  , m)  =  [manDVl ; manDV2 ; manDV3] ; 

end 

%  J (m)  =  manDVl  +  manDV2  + 

manDV3 ; 

end 

end 

end 

end 

*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *******  c  o  n  s  t  r  a i n t  Equations 


%% 


%% 
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%round  cost  to  nearest  precision  required 
J  =  roundC J *  IQ" prec (n+1) ) /lO" prec (n+1) ; 

if  k  ==  1 

Jpbest  =  J ; 
pbest  =  x; 

J  subp  =  J  subs ; 
parfor  aa  =  1: swarm 
Jtemp  =  J ; 
nup  =  aa+nhood/2; 
ndown  =  aa-nhood/2; 

indl  =  (ndown : 1 : nup) ; 
inddown  =  £ind(indl  <  1) ; 
indl (inddown)  =  swarm+indl (inddown) ; 
indup  =  £ind(indl  >  swarm); 
indl(indup)  =  indl (indup) -swarm ; 

[Jlbest(aa) , indmin]  =  min(J temp (indl) ) ; 
lbest(:,aa)  =  x (:, indl (indmin) ) ; 


end 

else 

parfor  aa  =  1: swarm 
Jtemp  =  J ; 
nup  =  aa+nhood/2; 
ndown  =  aa-nhood/2; 

indl  =  (ndown : 1 : nup) ; 

inddown  =  £ind(indl  <  1) ; 

indl (inddown)  =  swarm+indl (inddown) ; 
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indup  =  £ind(indl  >  swarm); 
indl(indup)  =  indl (indup) -swarm ; 

[ Jmintemp , indmin]  =  min (J temp (indl)) ; 
i£  Jmintemp  <  Jlbest(aa) 
llbest(aa)  =  Imintemp; 
lbest(:,aa)  =  x (:, indl (indmin) ) ; 

end 

i£  Itemp(aa)  <  Jpbest(aa) 

Jpbest(aa)  =  Jtemp(aa); 
pbest(:,aa)  =  x(:,aa); 

Jsubp(:,aa)  =  Jsubs(:,aa); 

end 

end 


end 

[ Jgbest , indgbest]  =  min(lpbest); 
gbest  =  pbest (:, indgbest) ; 

Jsubout  =  J subp (:, indgbest) ; 

di££  =  zeros (swarm  ,  1)  ; 
par£or  y  =  1 : swarm 

di££(y)  =  Jgbest  -  Jpbest(y); 

end 

indcount  =  £ind(abs(di ££)<!©''  (-prec (n+1)  ) )  ; 

JG(k)  =  Jgbest ; 
manDV  =  Jgbest ; 

JGmin  =  Jgbest ; 
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282 


283  i  £  k  >  1 

284  if  JGCk)  ==  JG(k-l) 

285  count  =  count  +  1; 

286  else 

287  %  MinCost  =  lgbest*lQ00 

288  %  k 

289  count  =  Q; 

290  end 

291  % 

292  % 

293  % 

294 

295  % 

296  % 

297  % 

298 

299  end 

300 

301  if  length(indcount)  >  Q.75*swarm 

302  ex_flag  =  0; 

303  break 

304  end 

305 

306  %  figure  (1) 

307  %  plot(xCl,:),x(2,;),’x’,lbestCl,:),lbestC2,:),’kO’,pbest(l,:), 

pbest(2, :) , ’ra. ’ ,gbest(l) ,gbest(2) , ’rO’) 

308  %  axis  ( [  llimC  1)  ulim(l)  llira(2)  ulim(2)]) 

309  % 

310  %  figure  (2) 

311  %  plot(xC3,:),x(4,;),’x’,lbestC3,:),lbestC4,:),’kO’,pbest(3,:), 

pbest(4, :) , ’m. ’ ,gbest(3) ,gbest(4) , ’rO’) 


if  length(indcount)  >  previndcount 
length (indcount) 

end 

if  length(indcount)  >  IQQ 
keyboard 

end 
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% 


axis  ( [  lliin(3)  ulim(3)  llira(4)  ulim(4)]) 


% 


% 


figure  (3) 


% 


pbest(6, :) , ’m. ’ , gbest (5) ,gbest(6) , ’rO’) 


% 


axis ( [ llim(5)  ulim(5)  lliraC6)  ulim(6)]) 


if  count  >  1088 
ex_flag  =  1; 
break 

end 

end 

if  k  ==  iter 

ex_flag  =  2; 

end 

%  figure 

%  plot (1 : iter , JG) 

%  titleC’Cost  vs.  Iteration  #’) 

%  xlabelC’#  iterations’) 

%  ylabel ( ’ cost  ’  ) 

%  grid 

%  axis  square 

D.3.4  Single  Burn  Maneuver  with  Multiple  Revolutions 

function  [rO , v8 , rti jk , vti jk , manDV , DVlvec , rmiss]  = 
Single_Burn_Maneuver_nrev (rf , vf , TOP , theta , ae , be) 
%UNTITLED2  Summary  of  this  function  goes  here 
%  Detailed  explanation  goes  here 
wgs84data ; 
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global  MU 


%%  determine  orbit  elements  at  spacecraft  entrance  into  exclusion  zone 
[a , ecc , inc , RAAN , w , nu]  =  RV2C0E (r£ , v£) ; 

%determine  position  vector  of  new  arrival  location 
h  =  cross (rf , vf) ; 

hunit  =  h/norm(h); 

vunit  =  v£/norm(v£) ; 

gunit  =  cross (vunit , hunit ) ; 

re  =  ae*be/sqrtC(be*cos(theta)) ”2  +  (ae*sin(theta)) "2) ; 

rtijk  =  rf  +  re -'Cos  (theta) '-vunit  +  re''sin(theta) '-gunit ; 

rmiss  =  norm(rtijk  -  rf) ; 


%%  determine  orbital  elements/position  vector  of  departure  location 
[nu0]  =  nu£_£rom_T0F (nu , -TOF , a , ecc) ; 

[r®  ,  vQ]  =  C0E2RV  (a  ,  ecc  ,  inc  ,  RAAN  ,  w  ,  nuO)  ; 

P®  =  2''pi*sqrt  (a^S/MU)  ; 

rat  =  TOF/P®; 
m  =  floor (rat) ; 
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%%  solve  lambert’s  problem  both  ways 

[Vis,  V2s,  extremal_distances_s ,  exit£lag_s]  =  lambert2 (rO ’ , rti jk ’ , TOP 
/(360O*24) ,m,MU) ; 

[Vll ,  V21 ,  extremal_distances_l ,  exit£lag_l]  =  lambert2 (r® * , rti jk ’ , -TOP 
/(360O*24) ,m,MU) ; 

i£  isnan(Vls (1) )  ==  1 

[Vis,  V2s,  extremal_distances_s ,  exit£lag_s]  =  lambert2 (r0 ’ , rti jk * , 
TOP/(3600*24)  ,0,MU) ; 
elsei£  isnan(Vll  (1) )  ==  1 

[Vll,  V21,  extremal_distances_l ,  exit£lag_l]  =  lambert2 (r® ’ , rti jk * , - 
TOP/(3600*24) ,0,MU) ; 

end 

DVS  =  normCVls  -  v0 ’ ) ; 

DVL  =  normCVll  -  v0 ’ ) ; 

i£  DVL  <  DVS 

manDV  =  DVL; 

DVlvec  =  Vll  -  v0  * ; 
vtijk  =  V21 ’ ; 

else 

manDV  =  DVS; 

DVlvec  =  Vis  -  v0  * ; 
vtijk  =  V2s ’ ; 


end 
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Appendix  E:  Code  for  Low  Thrust  Responsive  Theater  Maneuvers 


E.l  Single  Pass  low-thrust  responsive  theater  maneuvers  (LTRTMs) 
E.1.1  Particle  Swarm  Algorithms 

E.l. 1.1  Single  Pass  LTRTM  PSO  Driver 

t®  =  Q; 

GMSTQ  =  0; 

latlim  =  [-10  10]*pi/180; 
longlim  =  [-50  -10]*pi/18®; 

wgs84data 
global  MU  MU2 
rOvec  =  [7300 ; 0 ; 0] ; 

vOvec  =  sqrt (MU/normCrOvec) ) * [0 ; 1/ sqrt (2) ; 1/sqrt  (2) ]  ; 

[a , ecc , inc , RAAN , w , nuO]  =  RV2C0E (rOvec , vOvec) ; 
period  =  2*pi*sqrt (a" 3/MU) ; 

aevec  =  [15®  140  130  120  110  100  90  8®  70  60  5®]; 
bevec  =  [15  14  13  12  11  10  9  8  7  6  5]  ; 

Rmaxvec  =  norm(rOvec) +50 ; 

Rminvec  =  norm(rOvec) -50; 

DU  =  normCrOvec)  ; 

TU  =  period/ (2*pi)  ; 

MU2  =  MU*TU''2/DU“3  ; 


mO  =  1000; 
rO  =  rOvec ; 
vO  =  vOvec ; 
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Rmax  =  Rmaxvec ; 

Rmin  =  Rminvec ; 

%Energy  of  most  elliptical  orbit 

ab  =  (Rmax  +  Rmin)/2;  %semi-major  axis  of  orbit 

Eb  =  -MU/(2*ab);  %energy  of  orbit 

Vmax  =  sqrt  (2*C]yiU/Rmin  +  Eb)); 

Vmin  =  sqrt  (2*(]yiU/Rmax  +  Eb)); 

state0= [rO  v® ] ; 

Tmax  =  2e-3; 

dir  =  ’C:\Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\Single 
Pass\Data\ * ; 

fid  =  fopen ( [dir  ’ PS0SinglePassData_Final_5 3 12014 . txt  * ] ,  ’ a ’ ) ; 

swarm  =  40 ; 
iter  =  1000; 
prec  =  [3 : 6 ; 3 ; 6] ; 

for  bb  =  2:11 


if  bb  ==  1 

fprintf (fid , ’ %s  %i\r\n’,’rQ  (km)  = ’ , rOvec (1) ) ; 
fprintf (fid , ’ %s  %i\r\n swarm  swarm); 
fprintf (fid %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  \r\n’, 
TOP ’ , ’Phi ’ , ’ Vf ’ , ’ fpa ’ , ’ DV ’ , ’ iter ’ , ’ time ’ ) ; 
fprintf(fid, ’%s\r\n’ , ’ 

- >); 

endval  =  20; 
else  endval  =  20; 
end 
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ae  =  aevec  (bb)  ; 
be  =  bevec (bb)  ; 


for  aa  =  1 : endval 

tstart  =  tic ; 

[rf 1 , v£l , t£l , lat_enter , long_enter , R_exit , V_exit , t_exit , lat_exit , 
long_exit]  =  zone_entry_exi t2 (r0 , vO , GMSTO , tO , latlim , longlim) 

j 

[ JGmin , Jpbest , gbest , X , k]  =  LT_RTM_PSO_TFIXED (3 , [Q  2*pi;Vmin  Vmax 
;-pi/2+8.®80®81  pi/2-8.888881] ,iter, swarm ,prec ,rfl ,vfl ,tfl , 
ae  ,  be  ,  DU  ,  TU  ,  MU  ,  Rmax  ,  Rmin  ,  Tmax  ,  m8)  ; 

Costl  =  JGmin*DU/TU*1888; 
tend  =  toc(tstart); 

fprintf (fid , ’%i  \t\t  %18.5f\t  %4.3£\t  %7.6£\t  %4.3£\t  %7.6£\t  %i 
\t  %4. l£\r\n’ ,ae,t£l ,gbest(l) ,gbest(2) ,gbest(3) , Costl ,k, tend 
)  ; 


end 


end 


E.1.1.2  Single  Pass  LTRTM  PSO  Algorithm 

function  [ IGmin , Jpbest , gbest , x , k]  =  LT_RTM_PSO_TFIXED (n , limits , iter , 
swarm  ,  prec  ,  rfvec  ,  vfvec  ,  tf ,  ae  ,  be  ,  DU  ,  TU  ,  MU  ,  Rmax  ,  Rmin  ,  Tmax  ,  m8) 


%Author :  Dan  Showalter  18  Oct  2812 
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%Purpose :  Utilize  PSO  to  solve  multi -orbit  sinegle  burn  maneuver  problem 


%generic  PSO  variable 
%  n:  #  of  design  variables 

%  limits:  bounds  on  design  variables  (n  x  2  vector)  with  first  element 
%  in  row  n  being  lower  bound  for  element  n  and  2nd  element  in  row  n 
being 

%  upper  bound  for  element  n 

%  iter:  number  of  iterations 

%  swarm:  swarm  size 


%Problem  specific  PSO  variables 
%  n  =  4 

%  nl  =  TOFl  =  TOP  of  first  maneuver 

%  n2  =  thetal  =  location  on  exclusion  ellipse  where  spacecraft 

will 


% 

% 

% 


arrive  upon 
n3  =  T0F2  = 
n4  =  theta2 


completion 
TOF  of  2nd 
=  location 


of  maneuver  1 
maneuver 

on  exclusion  ellipse  where  spacecraft 


will 


% 


arrive  upon 


completion 


of  maneuver  2 


%Specific  Problem 
%  rfl:  expected 
%  vfl:  expected 
%  ae :  semimajor 
%  be:  semiminor 
%  Rmax :  maximum 


Variables 

position  vector  when  spacecraft  enters  exclusion  zone 
velocity  vector  when  spacecraft  enters  exclusion  zone 
axis  of  exclusion  ellipse 
axis  of  exclusion  ellipse 

allowable  distance  from  Earth  (constraint  on  maneuvers 


) 


% 

% 


Rmin :  minimum  alowable  distance  from  Earth 
latlim:  vector  defining  latitude  bounds  on 


(constraint  on  maneuvers) 
exclusion  zone 
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%  longlim:  vector  defining  longitude  bounds  on  exclusion  zone 
%  end  time  of  maneuver  sequence 

%% 

[N,M]  =  size (limits) ; 

Him  =  limits(:,l); 
ulim  =  limits(:,2); 

if  N“=n 

fprintf C ’ Error !  limits  size  does  not  match  number  of  variables’) 
stop 

end 

gbest  =  zerosCn,!); 

X  =  zeros (n , swarm) ; 

V  =  zeros (n , swarm) ; 
pbest  =  zeros (n , swarm) ; 

Jpbest  =  zeros (swarm  ,  1)  ; 
d  =  (ulim  -  Him)  ; 

JG  =  zeros  (iter  ,  1)  ; 

J  =  zeros (iter , swarm) ; 

count  =  0; 

IND  =  0; 

CoreNum  =  12 ; 

if  (matlabpool ( ’ size ’ ) ) <=0 

matlabpool ( ’ open ’ , ’local ’ , CoreNum) ; 

else 
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disp ( *  Parallel  Computing  Enabled ’ ) 

end 

%loop  until  maximum  iteration  have  been  met 
for  k  =  1 : iter 

%create  particles  dictated  by  swarm  size  input 
parfor  h  =  1 : swarm 

%  if  this  is  the  first  iteration 
if  k  ==  1 

X  (  :  ,  h)  =  random  (  ’  unif  *  ,  Him  ,  ulim  ,  [n  ,  1]  )  I 
V ( : , h)  =  random ( ’ unif  * ,-d,d,[n,l]); 

%if  this  is  after  the  first  iteration,  update  velocity  and 
position 

%of  each  particle  in  the  swarm 

else 

%set  random  weighting  for  each  component 
ci  =  2/abs(2-2*2.09  -  sqrt(4.18''2  -  4*4.18)); 

%  ci  =  (S).7/(n-l)*k  +  (1.2  -  Q  .  7/ (n- 1)  )  ; 

cc  =  2 . 09*random( ’ unif ’  ,  0 , 1) ; 
cs  =  2 . 09*random( ’ unif ’  ,  0 , 1) ; 


vdum  =  v( : , h) ; 

%update  velocity 

vdum  =  ci''(vdum  +  cc  *  (pbest  ( :  ,  h)  -  x(:,h))  +  cs*Cgbest  -  x 
(: ,h))) ; 
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%check  to  make  sure  velocity  doesn’t  exceed  max  velocity  for 
each 
%variable 
for  w  =  l:n 

%if  the  variable  velocity  is  less  than  the  min,  set  it 
to  the  min 
if  vdum(w)  <  -d(w) 
vdum(w)  =  -d(w) ; 

%if  the  variable  velocity  is  more  than  the  max,  set 
it  to  the  max 
elseif  vdum(w)  >  d(w) ; 
vdum(w)  =  d(w) ; 

end 

end 

V ( : , h)  =  vdum ; 

%update  position 
xdum  =  x(:,h)  +  v(:,h); 

for  r  =  l:n 

%if  particle  has  passed  lower  limit 
if  xdum(r)  <  llimCr) 
xdum(r)  =  llim(r) ; 

elseif  xdumCr)  >  ulim(r) 
xdum(r)  =  ulim(r) ; 

end 

X ( : , h)  =  xdum ; 
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end 


end 


end 

*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  c  o  s  t  Function 


parfor  m  =  1 : swarm 

%  *  *  *  *  *  *  *  *********  ^  Q  5  ^  function  evaluation  here 


MU2  =  MU*TU''2/DU''3; 


phi  =  X  C 1 , m) ; 

Vt_mag  =  x (2 , m) ; 

£pa_t  =  xC3 ,m) ; 

[DV  rt_i  jk  ,  vt_i  jk  ,  "  ,  =  Single_LT_Maneuver  ( 

rfvec  ,  vfvec  ,  t£  ,  phi  ,  ae  ,  be  ,  Vt_mag  ,  £pa_t  ,  DU  ,  TU  ,  MU2)  ; 

%  maxT  =  maxT*DU/TU " 2 ; 

[a , ecc , inc , RAAN , w , nu]  =  RV2C0E  Crt_i jk , vt_i jk) ; 

Ra  =  a* ( 1+ecc) ; 

Rp  =  a*Cl-ecc); 

%  if  maxT  >  Tmax/mO 

%  J (m)  =  Inf ; 

%  else 

if  Ra  >  Rmax  | |  Rp  <  Rmin 
1 (m)  =  Inf ; 
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else 


JCm)  =  DV; 

end 


end 


*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *******  c  o  n  s  t  r  a i n t  Equations 


%% 


%% 


%round  cost  to  nearest  precision  required 
J  =  roundC J * lO" prec (n+1) ) /lO" prec (n+1) ; 

if  k  ==  1 

count  =  0; 

Jpbest (1 : swarm)  =  J(l: swarm); 
pbest  (  :  , 1 : swarm)  =  x ( :  , 1 : swarm) ; 

[Jgbest,IND]  =  min( Jpbest (:)) ; 
gbest  (:)  =  x(:  , IND) ; 


else 


Jtemp  =  J ; 

parfor  h=l: swarm 

if  Jtemp(h)  <  Jpbest(h) 
Jpbest (h)  =  J (h) ; 
pbest(: ,h)  =  x(: ,h) ; 
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end 


end 

[ Jgbest , indgbest]  =  minC Jpbest) ; 
gbest  =  pbest (:, indgbest ) ; 


end 


di££  =  zeros (swarm  ,  1)  ; 
par£or  y  =  1 : swarm 

di££(y)  =  Jgbest  -  Jpbest(y); 

end 

indcount  =  £ind  (abs  (di££)  <10'' (-prec  (n+1)  )  )  ; 


JG(k)  =  Jgbest ; 
JGmin  =  Jgbest ; 


i£  lengthCindcount)  ==  swarm 
break 

end 

i£  k  >  1 

i£  JGCk)  ==  JG(k-l) 

count  =  count  +  1; 
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else 


count  =  0; 

end 


end 


end 

E.1.1.3  Single  Low  Thrust  Maneuver 

function  [LT_DV , maxT , r , gamma , T_a , thetaf_int , theta_dot , theta_ddot , rdot , 
Tvec , T0F_calc , rt_i jk , vt_i jk , rt_pqw , vt_pqw , r®_pqw , v®_pqw , rf_pqw , 
vf_pqw , rmiss]  =  Single_LT_Maneuver (rf , vf , TOF , phi , ae , be , Vt_mag , fpa_t , 
DU,TU,MU2) 

%Single_LT_Maneuver  computes  a  feasible  low  thrust  maneuver  to  intercept 
rf 

%at  a  specified  time 
wgs84data ; 

%INPUTS 

%  rf  =  inertial  position  vector  at  expected  arrival  location  (DU) 

%  vf  =  inertial  velocity  vector  at  expected  arrival  location  (DU/TU) 

%  TOF  =  time  of  flight  (TU) 

%  phi  =  angle  of  exclusion  ellipse  (rad) 

%  ae  =  exclusion  ellipse  semi-major  axis  (DU) 

%  be  =  exclusion  ellipse  semi-minor  axis  (DU) 

%  Vt_mag  =  velocity  magnitude  at  new  arrival  location  (DU/TU) 

%  fpa_t  =  flight  path  angle  at  new  arrival  location  (rad) 

%0UTPUTS 

%LT_DV  =  total  delta  V  required  for  shape-based  maneuver  (DU/TU) 

%maxT  =  maximum  thrust  acceleration  allowed  (DY/TU"2) 
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%r  =  vector  of  radius  values  (DU)  in  perifocal  frame 
%T_a  =  thrust  acceleration  profile  (DU/TU''2) 

%thetaf_int  =  vector  of  theta  values  (rad) 

%theta_dot  =  vector  of  time  rate  of  change  of  thetaf_int  (rad/TU) 
%theta_ddot  =  vector  of  time  rate  of  change  of  theta_dot  (rad/TU''2) 
%rdot  =  vector  of  rate  time  rate  of  change  of  r  (DU/TU) 

%Tvec  =  vector  of  time  values  (TU) 

%T0F_calc  =  calculated  time  of  flight  (TU)  -  should  match  TOF 
%rt_ijk  =  inertial  position  vector  ,vt_ijk 

% 

MU  =  3986Q0. 5; 

%%  determine  inertial  position  vectors  of  maneuver  initiaion  and 
completion 

[a , ecc , inc , RAAN , w , nu]  =  RV2C0E (rf , vf ) ; 

period  =  2''pi ''sqrt  (a"  3/MU)  ; 

%determine  position  vector  of  new  arrival  location 
h  =  cross (rf , vf ) ; 

hunit  =  h/norm(h); 

vunit  =  vf/norm(vf) ; 

gunit  =  cross (vunit , hunit) ; 

re  =  ae*be/sqrt  ((be*cos(phi)) ''2  +  (ae''sin(phi))  "2)  ; 

%inertial  position  vector  of  new  arrival  position 
rt_ijk  =  rf  +  re''cos(phi) -'vunit  +  re''sin(phi) -'gunit ; 
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%inertial  velocity  vector  at  arrival 

%maneuver  is  coplanar  so  expected  angular  momentum  is  in  same  direction 
as 

%actual  angular  momentum  at  arrival 

%unit  vector  used  to  help  determine  actual  velocity  vector 
funit  =  cross (hunit , rt_i jk)/normCrt_i jk) ; 

vt_i  jk  =  Vt_mag  *  sin(£pa_t)  ''rt_i  jk/norm(rt_i  jk)  +  Vt_mag  *  cos  (£pa_t)  *  funit 


rmiss  =  norm(rt_ijk  -  r£)  ; 


%  determine  orbital  elements/position  vector  of  departure  location 
[nuO]  =  nu£_£rom_T0F (nu , -TOF , a , ecc) ; 

[r0_i jk , v0_i jk]  =  C0E2RV (a , ecc , inc , RAAN , w , nu0) ; 


%  convert  inertial  coordinates  to  perifocal  frame 
[r0_pqw , v0_pqw]  =  I JK_to_PQW (r0_i jk , v0_i jk , inc , RAAN , w) ; 

[rt_pqw , vt_pqw]  =  I JK_to_PQW (rt_i jk , vt_i jk , inc , RAAN , w) ; 

[r£_pqw , v£_pqw]  =  I JK_to_PQW (r£ , v£ , inc , RAAN , w) ; 

%determine  total  transfer  angle 

cos_psi  =  (re''2  -  normCr£_pqw)  "2  -  norm  (rt_pqw)  "  2)  /  ( -2*norm  (rf_pqw) -'norm 
(rt_pqw)) ; 

psi  =  acos Ccos_psi)  ; 

%expected  flight  path  angle 
[fpa_l]  =  £pa_calc (ecc , nu) ; 
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i£  phi  >  pi/2-£pa_l  &&  phi  <  3''pi/2 - £pa_l 


psi  =  -psi; 

end 

%total  trans£er  angle 
revs  =  TOF/period; 

nrevs  =  £loor(revs); 

i£  nu  >  nu® 

angl  =  nu-nuO; 

else 

angl  =  2*pi  +  nu-nu®; 

end 


ang  =  angl+2*pi*nrevs ; 


theta£  =  ang  +  psi ; 


%£light  path  angle  o£  satellite  at  maneuver  initiation 
[gamma®]  =  £pa_calc (ecc , nu®) ; 


%%  scale 
r®_pqw  = 
v®_pqw  = 
rt_pqw  = 
vt_pqw  = 
r£_pqw  = 
v£_pqw  = 


vectors 
r®_pqw/DU ; 
v®_pqw/DU*TU; 
rt_pqw/DU ; 
vt_pqw/DU*TU ; 
r£_pqw/DU ; 
v£_pqw/DU*TU; 


TOF  =  TOF/TU; 
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Ill  [LT_DV , maxT , r , gamma , T_a , thetaf_int , theta_dot , theta_ddot , rdot , Tvec , 

TOF_calc]  =  LT_TF_FIXED_FO (rO_pqw , vO_pqw , rt_pqw , vt_pqw , thetaf , gammaQ 
, fpa_t ,TOF ,MU2) : 

E. 1.1.4  Calculate  Flight  Path  Angle 

1  function  [fpa]  =  fpa_calc (e , nu) 

2  %Generates  flight  path  angle  as  a  function  of  orbit  eccentricity  and 

flight 

3  %path  angle 

4 

5  %INPUTS 

6  %  e  =  orbit  eccentricity  (unitless) 

7  %  nu  =  orbit  true  anomaly  (rad) 


9  %OUTPUT 

10  %  fpa  =  flight  path  angle  (rad) 

11 

12  %sin  of  flight  path  angle 

13  sin_fpa  =  (e*sin(nu)  ) /sqrt  ( l  +  2*e*cos  (nu) +e ''2)  ; 

14 

15  %cos  of  flight  path  angle 

16  cos_fpa  =  ( l+e*cos (nu) ) /sqrt ( l+2*e*cos (nu) +e "2) : 

17 

18  fpa  =  atan2  (sin_fpa  ,  cos_fpa)  ; 

19 

20 

21  end 


E.1.1.5  Shape-Based  Low  Thrust  Trajectory  Optimization 

1  function  [LT_DV , maxT , r , gamma , T_a , thetaf_int , theta_dot , theta_ddot , rdot , 
Tvec , T0F_calc]  =  LT_TF_FIXED_F0 (rlvec , vlvec , rfvec , vfvec , thetaf , 
gammal , gammaf , TOF , MU) 
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%UNTITLED2  Summary  of  this  function  goes  here 
%  Detailed  explanation  goes  here 


%INPUTS 

%rlvec  =  position  vector  (3x1)  of  initial  orbit  at  theta©  (DU) 
%vlvec  =  velocity  vector  (3x1)  of  initial  orbit  at  theta©  (DU/TU) 
%rfvec  =  position  vector  (3x1)  of  final  orbit  at  thetaf  (DU) 
%vfvec  =  velocity  vector  (3x1)  of  initial  orbit  at  theta©  (DU/TU) 
%gammal  =  flight  path  angle  of  initial  orbit  at  thetal  (rad) 
%gamma2  =  flight  path  angle  of  final  orbit  at  thetaf  (rad) 

% 


hlvec  =  cross (rlvec , vlvec) ;  %specific  angular  momentum  of  body  1 
hi  =  norm(hlvec);  %magnitude  of  specific  angular  momentum 

rl  =  norm(rlvec);  %magnitude  of  position  vector 

hfvec  =  cross (rfvec , vfvec) ;  %specific  angular  momentum  of  body2  at 
thetaf 

hf  =  norm(hfvec);  %magnitude  of  specific  angular  momentum 

rf  =  norm(rfvec);  %magnitude  of  position  vector 

vf  =  norm(vfvec) ; 

a  =  1/rl;  %parameter  a 
b  =  -tan(gammal)/rl ;  %parameter  b 

thetadotl  =  hl/(rl''2);  %rate  of  change  of  thetal 
thetadotf  =  hf/(rf''2)  ; 

c  =  l/(2*r  1)  *  (MU/(r  1 "  3*  thetadot  1 ''2)  - 1)  ;  %parameter  c 
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flag  =  0; 
guess  =  0; 
n  =  Q ; 


0 


step  =  . 1 ; 
total  =  2®; 
while  flag  == 

options  =  optimset (’ Display off ; 

[d , FVAL , ex_flag]  =  fzero(@(x)  TF_PARAM_d_RTM_fQ (x , rf , TOF , thetaf , 
gammaf , a , b , c , thetadotf , MU , n , step) , guess .options) ; 
if  d  ==  guess  &&  FVAL  ==  ® 
if  n  <  total  &&  n  >=  0 

guess  =  guess  +  step; 
n  =  n  +  1 ; 
elseif  n  ==  total 
guess  =  -step; 
n  =  -1; 

else 

guess  =  guess  -  step; 
n  =  n  -  1 ; 

if  n  ==  -step*total; 
flag  =  1; 

end 

end 

else 

flag  =  1; 

end 


end 

if  ex_flag  ~=1 

%  dispC’Fzero  did  not  converge  to  a  solution’) 

LT_DV  =  Inf; 
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maxT  =  Inf ; 
r  =  0; 
gamma  =  0; 

T_a  =  0; 
thetaf_int  =  0; 
theta_dot  =  0; 
theta_ddot  =  0; 
rdot  =  0; 

Tvec  =  0; 
T0F_calc  =  0; 

%  gammaf 

%  v£ 


else 


matl  =  [30*  thetaf^Z  -10*theta£''3  theta£''4  ;  .  .  . 
-48*theta£  18*theta£''2  -2*theta£'' 3  ;  .  .  . 

20  -8*theta£  theta£''2]  ; 

mat2  =  [l/r£-(a+b*theta£+c*theta£''2  +  d*theta£''3)  ;  .  .  . 
-tan(gamma£)/r£-(b  +  2*c*theta£+3*d*theta£''2)  ;  .  .  . 
MU/  (r£''4*  thetadotf"  2)  -  (1/ r£+2*c  +  6*d*  thetaf)  ]  ; 


soln_vec  =  1/(2* thetaf" 6) *matl*mat2 ; 

e  =  soln_vec(l);  %parameter  d 
£  =  soln_vec(2);  %parameter  e 
g  =  soln_vec(3);  %parameter  £ 

theta£_int  =  linspace (0 , thetaf , 100) ;  %set  up 
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94  theta  =  theta£_int ;  %theta  values 

95 

96  r  =  l./(a  +  b*thetaf_int  +  c*theta£_int . "2  +  d*theta£_int . " 3  +  e* 

theta£_int . "4  +  £*theta£_int . “ 5  +  g*theta£_int . "6) ;  %r  values 
based  on  parametric  representation  as  a  £unction  o£  theta 

97 

98  tan_gamma  =  -r.*(b  +  2*c  .  *theta£_int  +  3*d .  *theta£_int . ''2  +  4*e.* 

theta£_int . " 3  +  5*£.  *theta£_int . ''4  +  6*g*theta£_int . " 5)  ;  % 
tangent  o£  £light  path  angle  (thrust  assumed  along  £pa) 

99 

100  gamma  =  atan (tan_gamma)  ;  %actual  £light  path  angle 

101 

102  denom  =  (l./r  +  2*c  +  6*d.*theta  +  12*e  .  *theta  .  "2  +  2Q*£.  *theta  . -I  + 

30*g . *theta . "4) ;  %denominator  o£  terms  used  to  compute  angular 
velocity  (theta_dot)  acceleration  (theta_ddot)  and  thrust 
acceleration  (T_a) 

103 

104  terml  =  4 .  *tan_gamma  . /denom ;  %term  used  £or  angular  acceleration  ( 

theta_ddot) 

105  term2  =  (6*d  +  24*e.*theta  +  60*£.  *theta  . ''2  +  120*g  .  *theta  .  “  3  - 

tan_gamma . /r) . /denom . " 2 :  %term  used  £or  angular  acceleration  ( 
theta_ddot) 

106 

107  theta_ddot  =  -MU  .  /  (2  .  *r  .  "4)  .  *  (terml  +  term2);  %angular  acceleration 

108  theta_dot  =  sqrt  (MU . /(r  .  "4)  .  * (1 . /denom)  )  ;  %angular  velocity 

109  T_a  =  -MU  .  /  (2  .  *  (r  . "  3)  .  *cos  (gamma)  )  .  *  term2  ;  %thrust  acceleration 

110 

111  rdot  =  -r.“2.*(b  +  2*c.*theta  +  3*d .  *theta  .  "2  +  4*e  .  *theta  .  “  3  +  5*£ 

.*theta.''4  +  6*g  .  *theta  . 5)  .  *theta_dot ; 

112 

113  maxT  =  max (abs  (T_a)  )  ; 

114 
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time_£unc  =  sqrt  (  (r  .  " 4/MU  . ''denom)  )  ;  %function  values  used  for 
quadrature  integration  of  time  of  flight 

dT  =  zeros (length (theta)  ,  1) ; 

Tvec  =  zeros (length(theta)  ,  1) ; 

for  aa  =  2 : length(theta) 
fa  =  time_func (aa-1) ; 

£b  =  time_func (aa) ; 

dT(aa)  =  (theta(aa)  -  theta (aa- 1) )* (fa  +  £b)/2; 

Tvec(aa)  =  Tvec(aa-l)  +  dT(aa); 

end 

T0F_calc  =  sum(dT) ; 

for  bb  =  2 : length(theta) 

%  Delta  V 

£a_DV  =  abs (T_a (bb - 1) ) /theta_dot (bb - 1) ; 

£b_DV  =  abs (T_a (bb) )/theta_dot (bb) ; 

DV_vec(bb)  =  (theta(bb)  -  theta (bb - 1) )* (£a_DV  +  £b_DV)/2; 

end 

LT_DV  =  sum(DV_vec); 


end 

E.1.1.6  Root  Finding  Equation 

function  [func]  =  TF_PARAM_d_RTM_£0 (x , rf , TOF , thetaf , gammaf , a , b , c , 
thetadotf , MU2 , n , step) 
d  =  X ; 
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matl  =  [30*theta£''2  -10*theta£''3  theta£''4 ;  .  .  . 

-48*theta£  18*theta£''2  -2*theta£'' 3  ;  .  .  . 

20  -8''theta£  theta£''2]  ; 

mat2  =  [l/r£-(a+b*theta£+C''theta£''2  +  d''theta£''3)  ;  .  .  . 

-tan(gamina£)/r£-(b-f2''c*theta£+3''d*theta£''2)  ;  .  .  . 

MU2/(r£''4'' thetadot£''  2)  -  (l/r£+2 ''c+6*d'' theta£)  ]  ; 

soln_vec  =  1/(2* theta£''6)  *matl*mat2  ; 

e  =  soln_vec(l);  %parameter  d 

£  =  soln_vec(2);  %parameter  e 

g  =  soln_vec(3);  %parameter  £ 

theta£_int  =  linspace (0 , theta£ , 100) ;  %set  up 

theta  =  theta£_int;  %theta  values 

r  =  l./(a  +  b*theta£_int  +  c*Ctheta£_int . "2)  +  d* Ctheta£_int . " 3)  +  e*C 
theta£_int . "4)  +  £*(theta£_int . "5)  +  g*Ctheta£_int . "6) ) ;  %r  values 
based  on  parametric  representation  as  a  £unction  o£  theta 

denom  =  (l./r  +  2*c  +  6*d*theta  +  12*e*(theta . "2)  +  20*£* ( theta . " 3)  + 
30*g*Ctheta . ''4))  ;  %denominator  o£  terms  used  to  compute  angular 
velocity  Ctheta_dot)  acceleration  Ctheta_ddot)  and  thrust 
acceleration  (T_a) 

ind  =  £indCdenom  <  0) ; 

time_£unc  =  sqrt ( ( (r . " 4) /MU2 ) . *denom) ;  %£unction  values  used  £or 
quadrature  integration  o£  time  o£  £light 
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for  aa  =  2 : length (theta) 
fa  =  time_func (aa- 1) ; 
fb  =  time_func (aa) ; 

dT(aa)  =  (theta(aa)  -  theta (aa- 1) )* (fa  +  fb)/2; 

end 

T0F_calc  =  sum(dT) ; 

func  =  T0F_calc  -  TOF ; 

if  norm(x  -  n*step)  <  le-6  &&  isreal (T0F_calc)  ==  0 

func  =  TOF  -  sqrt  (real  (T0F_calc) ''2  +  imag  (T0F_calc)  "2)  ; 

end 

end 

E.1.2  Direct  Collocation  Algorithms 
E.1.2.1  Single  Pass  LTRTM  Driver 

for  zz  =  2:2 

if  zz  ==  1 

load (’C:\Users\D an  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Single  Pass\Data\data680O_LT_lRTMsort . mat ’ ) 

PS0_data  =  data6800_LT_lRT]yisort ; 
rmag  =  6800; 
elseif  zz  ==  2 

load (’C:\Users\D an  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Single  Pass\Data\data7300_LT_lRTMsort . mat ’ ) 

PS0_data  =  data7300_LT_lRT]yisort ; 
rmag  =  7300; 

end 
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for  cc 


1:22 


fid2  =  fopenC  ’  C  : \Users\Dan  Showalter\Docuinents\MATLAB\Low  Thrust 
RTM\ Single  Pass\Data\PS02GP0PSSinglePassData . txt ’ , ’ a ’ ) ; 
clear  guess  setup  limits  output 

clc 

tstart  =  tic ; 

fid  =  fopen ( *  PS0_to_GP0PS . txt ’  , ’ a ’ ) ; 

to  =  0; 

GMSTO  =  0; 

latlim  =  [-10  10]''pi/180; 
longlim  =  [-50  -10]*pi/180; 

wgs84data 
global  MU 

rOvec  =  [rmag;0;0]; 

vOvec  =  sqrt (MU/norm(rOvec) ) * [0 ; 1/sqrt (2) ; l/sqrt(2)] ; 

[a  ,  ecc  ,  inc  ,  RAAN  ,  w  ,  nuO]  =  RV2COE  (rOvec  ,  vOvec)  ; 
period  =  2 ''pi*sqrt  (a"  3/MU)  ; 

swarm  =  30; 
iter  =  1000; 

Rmaxvec  =  normCrOvec) +50 ; 

Rminvec  =  normCrOvec) -  50 ; 
prec  =  [2  ;  5 ;  16] ; 

rO  =  rOvec ; 
vO  =  vOvec ; 

Rmax  =  Rmaxvec; 
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Rmin  =  Rminvec; 


ae  =  PS0_data  (cc  ,  1)  ; 
be  =  ae/10; 

TOP  =  PS0_data(cc  ,2)  ; 
phi  =  PS0_data (cc  ,  3)  ; 

Vt_mag  =  PS0_data (cc  ,  4)  ; 

£pa_t  =  PS0_data (cc  ,  5)  ; 

tstart  =  tic ; 

[rf 1 , v£l , t£l , lat_enter , long_enter , R_exit , V_exit , t_exit  ,  lat_exit  , 
long_exit]  =  zone_entry_exi t2 (r0 , vO , GMSTO , t0 , latlim , longlim) 


DU  =  norm(r£l) ; 

TU  =  period/(2*pi); 

ael  =  ae/DU; 
bel  =  be/DU; 
r01  =  norm(r0)/DU; 
MU2  =  MU*TU''2/DU''3; 


tQmin 

=  Q; 

%  minimum 

initial 

time 

tQmax 

%  maximum 

initial 

time 

tfmin 

=  period/TU;  % 

minimum 

final  time 

t£max  =  period/TU; 

n0  =  sqrt (MU2/(norm(r0)/DU)  ”3) ; 


[LT_DV  ,  maxT  ,  r  ,  gamma  ,  T_a  ,  theta£_int  ,  theta_dot  ,  theta_ddot  ,  rdot  , 
Tvec  ,  T0F_calc  ,  rt_i  jk  ,  vt_i  jk  ,  rt_pqw  ,  vt_pqw  ,  r0_pqw  ,  v0_pqw]  = 
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Single_LT_Maneuver  (r£l  ,  v£l  ,  TOP  ,  phi  ,  ae  ,  be  ,  Vt_mag  ,  £pa_t  ,  DU  ,  TU  , 
MU2)  ; 

delt  =  (t£l  -  TOF)/TU; 
time_inod  =  Tvec  +  delt; 

[r£_pqw , v£_pqw]  =  I JK_to_PQW  Cr£l , v£l , inc , RAAN , w) ; 
r£_pqw  =  r£_pqw/DU; 
v£_pqw  =  v£_pqw/DU''TU ; 


vunit  =  v£_pqw/norm ( v£_pqw) ; 
h£p  =  cross (r£_pqw , v£_pqw) ; 
hunit  =  h£p/norm(h£p) ; 

gunit  =  cross (vunit , hunit) ; 

ang  =  (0 : Q . 001 : 2*pi) ; 

re  =  (ael*bel) ./sqrt ((bel*cos(ang)) . "2  +  (ael*sin(ang)) . "2) ; 


theta_r£  =  atan2  Cr£_pqw (2) , r£_pqw (1) ) ; 
i£  theta_r£  <  0 

theta_r£  =  2*pi  +  theta_r£; 

end 

[rtest ]  =  I JK_to_PQW (r0 , v0 , inc , RAAN  ,  w)  ; 
thetaO  =  atan2 (rtest (2) ,rtest(l)) ; 

theta_mod  =  theta£_int  +  atan2 (r0_pqw (2) , r0_pqw ( 1) ) ; 

coast_length  =  1; 
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time_guess  =  zeros (coast_length+length(time_mod) , 1) ; 
time_guess (1 : coast_length)  =  Q; 
time_guess (coast_length+l : end)  =  time_mod ; 
theta_guess  =  zeros  (coast_length+length(theta_inod)  ,  1)  ; 
theta_guess (coast_length+l : end)  =  theta_mod ; 
theta_guess (1 : coast_length)  =  thetaO ; 
r_guess  =  zeros (coast_length+lengthCtheta_mod) , 1) ; 
r_guess (1 : coast_length)  =  norm (rO) /DU ; 
r_guess (coast_length+l : end)  =  r; 

vr_guess  =  zeros (coast_length+length(theta_mod) , 1) ; 
vr_guess (1 : coast_length)  =  ®; 
vr_guess (coast_length+l : end)  =  rdot ; 

vtheta_guess  =  zeros ( c oas t_l eng th+ length (the ta_mod) , 1) ; 
vtheta_guess ( 1 : coast_length)  =  sqrt  CMU2/(normCr0) /DU) ) ; 
vtheta_guess (coast_length+l : end)  =  r . *theta_dot ; 

T_guess  =  zeros (coast_length+length (time_mod) , 1) ; 

T_guess (1 : coast_length)  =  0; 

T_guess (coast_length+l : end)  =  T_a ; 

B_guess  =  zeros (coast_length+lengthCtime_mod) , 1) ; 

B_guess (1 : coast_length)  =  0; 

B_guess (coast_length+l : end)  =  gamma ; 

ind  =  £ind(T_guess  “=  0); 

%inertial  position  vector  o£  new  arrival  position 
£or  aa  =  1 : length (ang) 

r_ell(:,aa)  =  r£_pqw  +  re (aa) *cos (ang (aa) ) *vunit  +  re(aa)* 
sin  (ang  (aa)  )  -'gunit ; 

end 

£or  dd  =  1 : length (r_guess) 
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rg_pqw  =  DU* [r_guess (dd) *cos (theta_guess (dd) ) ; r_guess (dd) * 
sin(theta_guess (dd) ) ;Q] ; 

[rgi (dd , : ) ]  =  PQW_to_I JK (rg_pqw , [] , inc , RAAN , w) ; 

end 

for  ee  =  1 : length (ang) 

rell_pqw  =  [r_ell (1 , ee) *DU ; r_ell (2,ee)*DU;0]; 
rnom_pqw  =  norm(rO) * [cos (ang (ee) ) ; sin (ang (ee) ) ; 0] ; 
[rell_ijk(:,ee)]  =  PQW_to_I JK (rell_pqw , [] , inc , RAAN , w) ; 
[rnom_i jk (ee , : ) ]  =  PQW_to_I JK (rnom_pqw , [] , inc , RAAN , w) ; 

end 

%%  GPOPS  RUN 

%  variables  from  PSo  phase 
rl  =  1; 

rf  =  norm(rt_pqw) ; 
rmax  =  rl  +  be/DU; 
rmin  =  rl  -  be/DU; 

thetaf_min  =  theta_rf  -  atan(ae/norm(rO) ) ; 
thetaf_max  =  theta_rf  +  atan(ae/norm(rO) ) ; 

%colocation  points  and  fraction 
colnum  =  4; 
colp  =  20; 

%  Control  and  time  boundaries 
if  phi  >  pi 

umin  =  0;  %  minimum  control  angle 

Umax  =  2*pi;  %  maximum  control  angle 

else 

umin  =  -pi;  %  minimum  control  angle 
Umax  =  pi ;  %  maximum  control  angle 

end 
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Tmax  =  2*®. 0801160; 

Tmin  =  Tmax/1000; 

%  GPOPS  Setup 
%  Phase  1  Information 
iphase  =  1; 

limits (iphase) . intervals  =  1; 

limits (iphase) . nodesperint  =  100; 

bounds . phase (iphase) . initialtime . lower  =  tOmin; 

bounds . phase (iphase) . initialtime . upper  =  tOmax ; 

bounds . phase (iphase) . finaltime . lower  =  tfl/TU; 

bounds . phase (iphase) . finaltime . upper  =  tfl/TU; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rl  theta_rf -nO*tf 1/TU 
0  sqrt(MU2/rl)] ; 

bounds . phase (iphase) . initialstate . upper  =  [rl  theta_rf -nO*tf 1/TU 
0  sqrt(MU2/rl)] ; 

bounds . phase (iphase) . finalstate . lower  =  [rmin  thetaf_min  -0.2 
8]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf_max  0.2 
1.1]  : 

bounds . phase (iphase) . state . lower  =  [rl-0.1  theta_rf -n0*tf 1/TU 
-0.2  0] ; 

bounds . phase (iphase) . state . upper  =  [rl+0.1  thetaf_max  0.2  1.1]; 
bounds . phase (iphase) . control . lower  =  [Tmin  umin] ; 
bounds . phase (iphase) . control . upper  =  [Tmax  umax] ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 

bounds . parameter . lower  =  0; 

bounds . parameter . upper  =  2*pi; 

bounds . phase (iphase) . path . lower  =  [] ;  %  None 

bounds . phase (iphase) . path . upper  =  [] ;  %  None 

bounds . phase (iphase) . integral . lower  =  0; 
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bounds . phase (iphase) .integral . upper  =  1 ; 

bounds . eventgroup (iphase) . lower  =[00  Rmin/DU  Rmin/DU] ;  %  None 
bounds . eventgroup (iphase) . upper  =[00  Rmax/DU  Rmax/DU] ;  %  None 
%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  time_guess ; 
guess . phase (iphase) .state(:,l)  =  r_guess ; 
guess . phase (iphase) .state(:,2)  =  theta_guess ; 
guess . phase (iphase) .state(:,3)  =  vr_guess ; 
guess . phase (iphase) .state(:,4)  =  vtheta_guess ; 

%  Control  guess  ; 

guess . phase (iphase) . control  (  :  , 1)  =  T_guess ; 
guess . phase (iphase) . control ( : , 2)  =  B_guess ; 
guess . parameter  =  phi; 
guess . phase (iphase) .integral  =  LT_DV ; 

%auxiliary  data 
auxdata.MU  =  MU2 ; 
auxdata . ae  =  ael ; 
auxdata .be  =  bel ; 
auxdata . rf_pqw  =  r£_pqw; 
auxdata . vunit  =  vunit; 
auxdata . gunit  =  gunit; 

%  NOTE:  Functions  " phasingmaneuverCost "  and  "phasingmaneuverDae" 
required 

setup .name  =  [ ’ TIME_FIXED_INTERCEPT ’  ] ; 

setup . functions . continuous  =  ©LT_RTM_Continuous ; 
setup . functions . endpoint  =  @LT_RTM_Endpoint ; 
setup . nip . solver  =  ’ ipopt * ; 
setup . mesh . maxiteration  =  10; 
setup . mesh . tolerance  =  le-12; 
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setup . mesh . colpointsmin  =  40; 
setup . mesh . colpointsmax  =  200; 

setup . mesh . phase (i phase) . colpoints  =  colnum*ones (1 , colp) ; 

setup . mesh . phase (iphase) .fraction  =  ( 1/ colp) * ones (1 , colp) ; 

setup. bounds  =  bounds; 

setup. guess  =  guess; 

setup . auxdata  =  auxdata; 

setup . mesh . method  =  ’ RPMintegration ’ ; 

setup . derivatives . supplier  =  ’ sparseFD ’ ; 

setup . derivative level  = ’ second ’ ; 

setup . dependencies  =  ’sparseNaN’; 

setup. scales  =  ’none’; 

output  =  gpops2 (setup) ; 

solution  =  output . result . solution ; 

r_GP0PS  =  solution . phase . state ( : ,1) ; 
theta_GPOPS  =  solution . phase . state  (  :  ,2)  ; 

Vr_GP0PS  =  solution . phase . state  (  :  ,3) ; 

Vt_GP0PS  =  solution . phase . state  (  :  ,  4)  ; 
lambda_r  =  solution . phase .costateC:,!); 
lambda_theta  =  solution . phase .cost at e(: ,2) ; 
lambda_Vr  =  solution . phase . costate  (  :  ,  3) ; 
lambda_Vt  =  solution . phase .cost at e(: ,4) ; 
tvec  =  solution . phase . time ; 

thetadot_GP0PS  =  Vt_GP0PS . /r_GP0PS ; 

T_GP0PS  =  solution . phase . control ( : , 1) ; 

Beta_GP0PS  =  solution . phase . control ( : , 2) ; 
phi_GP0PS  =  solution . parameter ; 

re_GP0PS  =  ae  1  *be  1/sqrt  ( (be  1 -'cos  (phi_GP0PS)  )  " 2  +  (ael*sin( 
phi_GP0PS)) "2) ; 
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Cost  =  solution . phase . integral*DU/TU* lOQQ 


rt  =  r£_pqw*DU  +  re_GPOPS*DU*cos (phi_GP0PS) * vunit  +  re_GPOPS*DU* 
sinCphi_GPOPS) *gunit ; 


%% 

clear  setup  guess  bounds 

colnum  =  4; 
colp  =  4Q; 

%  GPOPS  Setup 
%  Phase  1  Information 
iphase  =  1; 

limits (iphase) . intervals  =  1; 

limits (iphase) . nodesperint  =  108; 

bounds . phase (iphase) . initialtime . lower  =  tOmin; 

bounds . phase (iphase) . initialtime . upper  =  tOmax ; 

bounds . phase (iphase) . finaltime . lower  =  tfl/TU; 

bounds . phase (iphase) . finaltime . upper  =  tfl/TU; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rl  theta_rf -nO*tf 1/TU 
0  sqrt (MU2/r 1) ] ; 

bounds . phase (iphase) . initialstate . upper  =  [rl  theta_rf -nO*tf 1/TU 
0  sqrt(MU2/rl)] ; 

bounds . phase (iphase) . finalstate . lower  =  [rmin  theta£_min  -0.2 

8]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf_max  0.2 
1.1]  : 

bounds . phase (iphase) . state . lower  =  [rl-0.1  theta_r£-nO*tf 1/TU 
-0.2  0] ; 
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bounds . phase (iphase) . State . upper  =  [rl+0.1  thetaf_max  8.2 
bounds . phase (iphase) . control . lower  =  [8  umin] ; 
bounds . phase (iphase) . control . upper  =  [Tmax  umax] ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 

bounds . parameter . lower  =  8; 

bounds . parameter . upper  =  2*pi: 

bounds . phase (iphase) . path . lower  =  [] ;  %  None 

bounds . phase (iphase) . path . upper  =  [] ;  %  None 

bounds . phase (iphase) . integral . lower  =  8; 

bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =[88  Rmin/DU  Rmin/DU] ; 

bounds . eventgroup (iphase) . upper  =[88  Rmax/DU  Rmax/DU] ; 

%  bounds . eventgroup (iphase) . lower  =  [88];  %  None 

%  bounds . eventgroup (iphase) . upper  =  [88];  %  None 

%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  tvec ; 

guess . phase (iphase) . state (:,  1)  =  r_GP0PS ; 

guess . phase (iphase) . state  (:,  2)  =  theta_GP0PS ; 

guess . phase (iphase) . state (:,  3)  =  Vr_GP0PS ; 

guess . phase (iphase) . state (:,  4)  =  Vt_GP0PS ; 

%  Control  guess  : 

guess  .  phase (iphase) . control  (:,  1)  =  T_GP0PS ; 
guess . phase (iphase) . control  (:,  2)  =  Beta_GPOPS ; 
guess . parameter  =  phi_GP0PS ; 
guess . phase (iphase) . integral  =  LT_DV ; 

%auxiliary  data 
auxdata.MU  =  MU2 ; 
auxdata.ae  =  ael; 
auxdata.be  =  bel; 
auxdata . rf_pqw  =  r£_pqw; 
auxdata . vunit  =  vunit ; 


1.1] ; 


%  None 
%  None 
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auxdata . gunit  =  gunit; 


%  NOTE:  Functions  " phasingmaneuverCost "  and  " phasingmaneuverDae " 
required 

rOstring  =  num2str (normCrOvec) ) ; 
aestr  =  num2str(ae); 
itstr  =  num2str (PS0_data (cc , end) ) ; 
tempstr  =  [aestr  itstr] ; 
aestring  =  num2str (tempstr) ; 

setup. name  =  [ ’ SinglePass ’  rOstring  aestring]; 

setup . functions . continuous  =  @LT_RTM_Continuous ; 

setup . functions . endpoint  =  @LT_RTM_Endpoint ; 

setup . nip . solver  =  ’ ipopt  ’  ; 

setup . mesh . maxiteration  =  50; 

setup . mesh . tolerance  =  le-12; 

setup . mesh . colpointsmin  =  40; 

setup . mesh . colpointsmax  =  200; 

setup . mesh . phase (iphase) . colpoints  =  colnum*ones (1 , colp) ; 

setup . mesh . phase (iphase) .fraction  =  ( 1/ colp )* ones (1 , colp) ; 

setup. bounds  =  bounds; 

setup. guess  =  guess; 

setup . auxdata  =  auxdata; 

setup . mesh . method  =  ’ RPMintegration * ; 

setup . derivatives . supplier  =  ’ sparseFD ’ ; 

setup . derivative level  =  *  second  ’  ; 

setup . dependencies  =  ’sparseNaN’; 

setup. scales  =  ’none’; 

output  =  gpops2 ( setup) ; 

solution 2  =  output . result . solution ; 
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r_GP0PS2  =  solution 2 . phase . state ( :  ,  1) ; 
theta_GPOPS2  =  solution2 . phase . state  (  :  ,  2) ; 

Vr_GP0PS2  =  solution2 . phase . state  (  :  ,3) ; 

Vt_GP0PS2  =  solution2 . phase . state  (  :  ,4)  ; 
lambda_r2  =  solution2 . phase .costate(:,l); 
lambda_theta2  =  solution2 . phase .cost at e(: ,2) ; 
lambda_Vr2  =  solution2 . phase .cost at e(:  ,3)  ; 
lambda_Vt2  =  solution2 . phase .cost at e(: ,4) ; 
tvec2  =  solution2 . phase . time ; 

thetadot_GP0PS2  =  Vt_GP0PS2 . /r_GP0PS2 ; 

T_GP0PS2  =  solution2 . phase . control ( : , 1) ; 

Beta_GP0PS2  =  solution2 . phase . control  (  :  ,  2) ; 
phi_GP0PS2  =  solution2 . parameter ; 

re_GP0PS2  =  ae  1 -'be  1/sqrt  (  (be  1  *  cos  Cphi_GP0PS2  )  ) '^  2  +  (ael*sin( 
phi_GP0PS2))  ''2)  ; 

Cost 2  =  solution2  .  phase  .  integral  *DU/TU''  100® 


£print£(£id, *%i\t  %10.5£\t  %4.3£\t  %4.3£\t  %4.3£\t  %6.5£\t  %6.5£ 
\t  %4 . 3£\r\n ’ , ae , TOP , phi , Vt_mag , £pa_t , PS0_data (cc , 6) *DU/TU , 
Cost2*DU/TU*lO00 , phi_GP0PS2) ; 


optans  .  ics  =  struct  (  ’  rO  *  ,  rOvec  ,  ’  v0  *  ,  vOvec  ,  ’  tO  *  ,  tO  ,  ’  ae  ’  ,  ae  ,  ’  be  ’  , 
be ,  *  Rmax ’  , Rmax ,  ’ Rmin ’ , Rmin ,  ’r£l’ ,r£l,  ’v£l’ ,v£l,  ’t£l’  ,t£l,  ’ 
latlim ’  , latlim ,  ’ longlim  * , longlim ,  ’ GMST0 ’  , GMSTO , . . . 

’ inc ’ , inc  ,  *  RAAN ’ , RAAN ,  ’  w  ’  ,  w  ,  ’ ang ’  , ang) ; 
optans. scale  =  struct ( ’ TU ^ TU , ’ DU ’ , DU , ’ MU ’ , MU2) ; 
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optans. entry  =  struct (’ lat_enter lat_enter long_enter ’ , 

long_enter  ,  ’  lat_exit  ’  ,  lat_exit  ,  ’  long_exit  ’  ,  long_exit  ,  ’  r_ell  ’ 
,r_ell, ’rtijk’ ,rt_ijk, ’vtijk’ ,vt_ijk); 

optans . phase  =  struct(’state’ ,solution2. phase (1) .state , ’costate’ 
, solut ion 2. phase(l). costate, ’ control ’ ,solution2. phase (1) . 
control , ’ time ’ , tvec2) ; 

optans . parameter  =  solution2 . parameter ; 

dir  =  ’C:\Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Single  Pass\Images\ ’ ; 

dir2  =  ’C:\Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Single  Pass\Data\’; 

tend  =  toc(tstart); 

exflag  =  output . result . nlpinfo ; 


if  cc  ==  1 

fprintf (fid2 , ’%s  %i  %s  %i  %s\r\n ’ , ’ colpoint  =  ’  , colnum ,  ’  (1 , ’  , 
colp,  ’)  ’)  : 

end 

if  exflag  ==  Q 

fprintf (fid2 , ’%i\t  %i  \t  %4.3f\t  %4.3f\t  %6.5f\t  %6.5f\t  %6.5f 
%5.2f\t  %i\t\r\n’ , . . . 

norm(rO) , ae , phi , phi_GP0PS2 , PS0_data (cc ,6),Cost,Cost2, tend  , 
exflag) ; 

[optfin]  =  LT_SINGLE_PASS_PLOTS (optans , rOstring , aestring , dir) : 
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dataname  =  [ ’ SinglePass ’  rOstring  aestring] ; 


save (strcat(dir2 , [dataname] ) , ’ output ’ ) ; 
end 

close  all 
clear  optfin 


end 

end 

£',7,2,2  Single  Pass  LTRTM  Equations  of  Motion  and  Cost  Function 

function  phaseout  =  LT_RTM_Continuous (input) 

s  =  input . phase . state ; 
u  =  input . phase . control ; 

%%  Equations  of  Motion 
% 


r  =  s(:  ,  1)  ; 
vr  =  s(: , 3) ; 
vtheta  =  s  C :  , 4) ; 

T  =  u(:  ,1)  ; 

B  =  u(: ,2) ; 

MU2  =  input . auxdata . MU ; 

r_dot  =  vr ; 

theta_dot  =  vtheta. /r; 
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vr_dot  =  (vtheta .  "2)  . /r  -  MU2./(i'-"2)  +  T.''sin(B); 
vtheta_dot  =  -vtheta  . -'vr  . /r  +  T.''cos(B); 

%  Form  matrix  output 

daeout  =  [r_dot  theta_dot  vr_dot  vtheta_dot] ; 

phaseout . dynamics  =  daeout; 

% 


%%  Cost  Function 
phaseout . integrand  =  T; 

E,l,2,3  Single  Pass  LTRTM  Constraints 

function  output  =  LT_RTM_Endpoint (input) 


%%  Cost  Function  Evaluation 
% 


J  =  input . phase (1) . integral ; 
output . obj ective  =  J; 

% 


%%  Event  Constraints 

to  =  input . phase (1) . initialtime ; 
t£  =  input . phase (1) . finaltime ; 
xO  =  input . phase (1) . initialstate ; 
xf  =  input . phase (1) . finalstate ; 
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r£  =  xf(l) ; 
thetaf  =  xf (2) : 

Vrf  =  xf (3) ; 

Vtf  =  xf (4) ; 

p  =  input . parameter ; 
phi  =  p(l)  ; 

ael  =  input . auxdata . ae ; 
bel  =  input.auxdata.be; 

MU2  =  input . auxdata . MU : 
rf_pqw  =  input . auxdata . rf_pqw ; 
vunit  =  input . auxdata . vunit ; 
gunit  =  input . auxdata . gunit ; 

terml  =  (bel*cos (phi) ) "2  +  (ael*sin(phi))  "2 ; 

re  =  ael*bel/sqrt (terml) ; 

rt  =  rf_pqw  +  re*cos(phi)*vunit  +  re*sin(phi)*gunit ; 

%final  position  constraints 
eventl  =  rf*cos (thetaf )  -  rt(l); 
event2  =  rf *sin(thetaf )  -  rt(2); 

%  output . eventgroup (1) . event  =  [eventl  event2]; 

%apogee  and  perigee  constraints 
Vf_mag  =  sqrt(Vrf''2  +  Vtf“2)  ; 
fpa  =  atan(Vrf/Vtf) ; 
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vt  =  Vf_mag*[-sin(theta£-£pa) ; cos (theta£-£pa) ;0] ; 

[a, ecc =  RV2C0E_MU(rt ,vt,MU2) ; 

Ra  =  a*(l+ecc); 

Rp  =  a*(l-ecc) ; 

events  =  Ra ; 
event4  =  Rp ; 

output . eventgroup (1) . event  =  [eventl  event2  events  event4] ; 

E,2  Double  Pass  LTRTMs 

E.2.1  Particle  Swarm  Algorithms 

E.2.1.1  Double  Pass  LTRTM  PSO  Driver 

wgs84data 
global  MU 

OmegaEarth  =  0.000072921151467; 

£or  bb  =  10 : 10 

to  =  0; 

GMSTO  =  0; 

latlim  =  [-10  10]*pi/180; 
longlim  =  [-50  -10]*pi/180; 

rOvec  =  [7S00 ; 0 ; 0] ; 

vOvec  =  sqrt (MU/norm(rOvec) ) * [0 ; 1/ sqrt (2) ; 1/sqrt (2) ] ; 

[a , ecc , inc , RAAN , w ,  nuO]  =  RV2C0E (rOvec , vOvec)  ; 
period  =  2*pi*sqrt(a''S/MU)  ; 

aevec  =  [150  140  ISO  120  110  100  90  80  70  60  50]; 
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bevec  =  [15  14  13  12  1 1  10  9  8  7  6  5]  ; 

Rmaxvec  =  norm(r0vec)+50 ; 

Rminvec  =  norm(r0vec)  -  50; 

DU  =  norm(r0vec) ; 

TU  =  period/(2*pi)  ; 

MU2  =  MU*TU''2/DU''3 ; 

m0  =  1000; 
r0  =  r0vec; 
v0  =  v0vec; 

Rmax  =  Rmaxvec ; 

Rmin  =  Rminvec ; 

%Energy  of  most  elliptical  orbit 

ab  =  (Rmax  +  Rmin)/2;  %semi-major  axis  of  orbit 

Eb  =  -MU/(2''ab);  %energy  of  orbit 

Vmax  =  sqrt (2* (MU/Rmin  +  Eb)); 

Vmin  =  sqrt (2* (MU/Rmax  +  Eb)); 

fid  =  fopen  C [dir  ’ PSODoublePassDataFinal_060120 14 . txt ’ ] , ’ a ’ ) ; 
state0= [r0  v0] ; 


Tmax  = 

2e-3: 

swarm 

=  40; 

iter  = 

1000; 

prec  = 

[5;5;5;9] 

if  bb 

==  1 

fprintf (fid , *%s  %i\r\n’,’r0  (km)  = * , r0vec (1) ) ; 
fprintf (fid , ’ %s  %i\r\n ’ , *  swarm  = ’ , swarm) ; 
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£print£(£id , *%s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  % 
s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t\r\n ’ , ’ TOP ’ , ’ Phi ’ , ’ V£ ’ , * £pa 
’ , *T0F2’  ,  ’Phi2* ,  ’ V£2 ’ , ’ £pa2 ’  ,  ’DV’ , ’DV2’  ,  ’ DVTOT ’ ,  ’iter’  ,  ’ 
iter 2 ’ , ’ iterTOT ’ , ’ time ’ , ’ time2 ’ , ’ timeTOT ’ ) ; 

£print£(£id, ’%s\r\n’ , ’ 


end 

i£  bb  ==  10 

endval  =  1; 

else 

endval  =  20; 

end 

ae  =  aevec  (bb)  ; 
be  =  bevec (bb)  ; 

[r£l ,v£l ,t£l , lat_enter , long_enter , R_exit , V_exit , t_exit  ,  lat_exit  , 
long_exit ]  =  zone_entry_exit2 (rO , vO , GMSTO , tO , latlim , longlim) ; 

£or  aa  =  1 : endval 

tstart  =  tic ; 

[ JGmin , Jpbest , gbest , X , k]  =  LT_RTM_PSO_TFIXED (3 , [0  2*pi;Vmin  Vmax 
;-pi/2 +0.00 0001  pi/2-0. 000001] , iter , swarm , prec , r£l , v£l , t£l , 
ae  ,  be  ,  DU  ,  TU  ,  MU  ,  Rmax  ,  Rmin  ,  Tmax  ,  mO)  ; 

Costl  =  lGmin*DU/TU*1000 
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tend  =  toc(tstart) 


tstart2  =  tic ; 

I' t_ijk,  vt_i  jk]  =  Single_LT_Maneuver  (rfl  , 
v£l  ,t£l  ,gbest(l)  ,ae,be,gbest(2)  ,gbest(3)  ,DU,TU,  MU2  )  ; 

[r£2 , v£2 , t£2]  =  zone_entry_exit2 (rt_i jk , vt_i jk , GMSTO+OmegaEarth* 
t£l , 0 , latlim , longlim) ; 

[JGmin2 , Jpbest2 ,gbest2 ,x2,k2]  =  LT_RTM_PSO_TFIXED (3 , [0  2*pi;Vmin 
Vmax ;-pi/2+0.000001  pi/2-0. 000001] , iter , swarm , prec , r£2 , v£2 , 
t£2  ,  ae  ,  be  ,  DU  ,  TU  ,  MU  ,  Rmax  ,  Rmin  ,  Tmax  ,  m0)  ; 

Cost2  =  JGmin2'"DU/TU*1000 

CostTOT  =  Costl  +  Cost2 

tend2  =  toc(tstart2) 


£print£(£id, ’%i\t  %i  \t  %10.5£\t  %6.5£\t  %7.6£\t  %6.5£\t  %10.5£\ 
t  %6.5£\t  %7.6£\t  %6.5£\t  %7.6£\t  %7.6£\t  %7.6£\t  %i\t  %i\t 
%i\t  %4.1£\t  %4.1£\t  %4. l£\r\n’ , . . . 

norm(r0) ,ae,t£l ,gbest(l) ,gbest(2) ,gbest(3) ,t£2 ,gbest2Cl) , 
gbest2(2) ,gbest2(3) , Costl ,Cost2 , CostTOT , k , k2 , k+k2 , tend , 
tend2 , tend+tend2) ; 
tend  +  tend2 
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clear  tstart  JGmin  Ipbest  gbest  x  k  Costl  tend  tstart2  rt_ijk 
vt_ijk  rf2  v£2  tf2  JGmin2  Jpbest2  gbest2  x2  k2  Cost2 
CostTOT  tend2 

end 


end 


E.2.2  Direct  Collocation  Algorithms 
E.2.2.1  Double  Pass  LTRTM  Driver 

for  zz  =  1:1 

clear  guess  setup  limits  output 

close  all 

clc 

if  zz  ==  1 

%  load( ’ C : \Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 

Double  Pass\ Journal  Data\data68Q8_LT_2RTiy[sort . mat  ’  ) 

%  [indO]  =  find(data688Q_LT_2RTMsort ( :  ,  1)  “=  8); 

%  PS0_data  =  data6888_LT_2RTMsort (ind8  ,  : ) ; 

loadC ’ C : \Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Double  Pass\Journal  Data\data6888_LT_2RTM_2ndTier . mat ’ ) 
[ind8]  =  findCdata6888_LT_2RTM_2ndTier ( :  ,  1)  8); 

PS0_data  =  data6888_LT_2RTM_2ndTier (ind8 , : ) ; 
cmax  =  lengthCPSO_data) ; 
cmin  =  1 ; 
rmag  =  6888; 
elseif  zz  ==  2 

%  load ( ’ C : \Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 

Double  Pass\Journal  Data\data7388_LT_2RTiy[sort  .mat  ’  ) 

%  [ind8]  =  find(data7388_LT_2RTiy[sort  ( :  ,  1)  “=  8); 

%  PS0_data  =  data7388_LT_2RTMsort (ind8  ,  :  ) ; 
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load (’C:\Users\D an  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Double  Pass\ Journal  Data\data730O_LT_2RTM_2ndTier .mat ’ ) 
[indO]  =  £indCdata73Q0_LT_2RTM_2ndTier  ( :  , 1)  “=  0); 

PS0_data  =  data7300_LT_2RTM_2ndTier (ind0 , :) ; 
cmax  =  lengthCPSO_data) ; 
cmin  =  1 ; 
rmag  =  7300; 

end 

tstart  =  tic; 

for  cc  =  cmin: cmax 

fid  =  fopen ( *  PS0_to_GP0PS_2RTM . txt  * , ’ a ’ ) ; 
clear  guess  setup  limits  output 
close  all 
clc 

t0  =  0; 

GMST0  =  0; 

latlim  =  [-10  10]''pi/180; 
longlim  =  [-50  - 10] ''pi/180 ; 

wgs84data 
global  MU2  MU 

OmegaEarth  =  0.000072921151467; 
r0vec  =  [rmag;0;0]; 

v0vec  =  sqrt (MU/norm(r0vec) ) * [0 ; 1/sqrt (2) ; l/sqrt(2)] ; 

[a  ,  ecc  ,  inc  ,  RAAN  ,  w  ,  nu0]  =  RV2C0E  (r0vec  ,  v0vec)  ; 
period  =  2 ''pi*sqrt  (a"  3/MU)  ; 

swarm  =  30; 
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iter  =  1000; 

Rmaxvec  =  rmag  +  50; 

Rminvec  =  rmag  -  50; 
prec  =  [2 ; 5 ; 16] ; 

r®  =  r®vec  ; 
vQ  =  v0vec  ; 

Rmax  =  Rmaxvec ; 

Rmin  =  Rminvec ; 

ae  =  PSO_data  (cc  ,  2)  : 
be  =  ae/18; 

TOP  =  PS0_data(cc  ,  3)  ; 
phi  =  PS0_data (cc  ,  4) ; 

Vt_mag  =  PS0_data (cc , 5) ; 

£pa_t  =  PS0_data (cc , 6) ; 

tstart  =  tic ; 

[rfl ,vfl ,t£l , lat_enter , long_enter , R_exit , V_exit ,t_exit ,lat_exit , 
long_exit]  =  zone_entry_exit2 (r® , v0 , GMST0 , t® , latlim , longlim) 


DU  =  norm(r£l) ; 

TU  =  period/(2*pi)  ; 

ael  =  ae/DU; 
bel  =  be/DU; 
rSl  =  norm(r®)/DU: 

MU2  =  MU*TU''2/DU"3: 

t®min  =  Q;  %  minimum  initial  time 
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tOmax  =  0;  %  maximum  initial  time 
tfmin  =  t£l;  %  minimum  final  time 
tfmax  =  t£l ; 

nO  =  sqrt  (MU2/(norm(r0)/DU) ''3)  ; 

%%  First  Maneuver 

[LT_DV  ,  maxT  ,  r  ,  gamma  ,  T_a  ,  theta£_int  ,  theta_dot  ,  theta_ddot  ,  rdot  , 
Tvec  ,  TOF_calc  ,  rt_i  jk  ,  vt_i  jk  ,  rt_pqw  ,  vt_pqw  ,  rQ_pqw  ,  v®_pqw]  = 
Single_LT_Maneuver  (rfl  ,  v£l  ,  TOF  ,  phi  ,  ae  ,  be  ,  Vt_mag  ,  £pa_t  ,  DU  ,  TU  , 
MU2)  ; 

delt  =  (t£l  -  TOF)/TU; 
time_mod  =  Tvec  +  delt; 

[r£_pqw , v£_pqw]  =  I JK_to_PQW (rfl , v£l , inc , RAAN , w) ; 
r£_pqw  =  r£_pqw/DU; 
v£_pqw  =  v£_pqw/DU*TU ; 


vunit  =  v£_pqw/norm ( v£_pqw) ; 
h£p  =  cross (r£_pqw , v£_pqw) ; 
hunit  =  h£p/norm(h£p) ; 

gunit  =  cross (vunit , hunit) ; 

ang  =  (0  :  0 . 001 :  2 ''pi)  ; 

re  =  (ael*bel) ./sqrt ((bel*cos(ang)) . "2  +  (ael*sin(ang))  .  "2) ; 


theta_r£  =  atan2  Cr£_pqw (2) , r£_pqw (1) ) ; 
if  theta_r£  <  0 

theta_r£  =  2*pi  +  theta_r£; 
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end 


[rtest ]  =  I JK_to_PQW (r0 , vO , inc , RAAN  ,  w)  ; 
theta©  =  atan2 (rtest (2) ,rtest(l)) ; 

theta_mod  =  theta£_int  +  atan2 (r0_pqw (2) , rQ_pqw ( 1) ) ; 

coast_length  =  1; 

time_guess  =  zeros (coast_length+length(time_mod) , 1) ; 
time_guess (1 : coast_length)  =  0; 
time_guess (coast_length+l : end)  =  time_mod ; 
theta_guess  =  zeros(coast_length+length(theta_mod) , 1) ; 
theta_guess (coast_length+l : end)  =  theta_mod ; 
theta_guess (1 : coast_length)  =  theta© ; 
r_guess  =  zeros (coast_length+lengthCtheta_mod) , 1) ; 
r_guess (1 : coast_length)  =  norm (r0) /DU ; 
r_guess (coast_length+l : end)  =  r; 

vr_guess  =  zeros (coast_length+length(theta_mod) , 1) ; 
vr_guess (1 : coast_length)  =  0; 
vr_guess (coast_length+l : end)  =  rdot ; 

vtheta_guess  =  zeros ( c oas t_l eng th+ length (the ta_mod)  ,  1) ; 
vtheta_guess ( 1 : coast_length)  =  sqrt (MU2/(norm(r0) /DU) ) ; 
vtheta_guess (coast_length+l : end)  =  r . *theta_dot ; 

T_guess  =  zeros (coast_length+length(time_mod) , 1) ; 
T_guess (1 : coast_length)  =  0; 

T_guess (coast_length+l : end)  =  T_a ; 

B_guess  =  zeros (coast_length+length(time_mod) , 1) ; 
B_guess (1 : coast_length)  =  0; 

B_guess (coast_length+l : end)  =  gamma ; 

ind  =  £ind(T_guess  0); 
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%inertial  position  vector  of  new  arrival  position 


for  aa  =  1 : length (ang) 

r_ellC:,aa)  =  rf_pqw  +  re  (aa)  *cos  (ang  (aa)  )  *vunit  +  re(aa)'' 
sin  (ang  (aa)  )  -'gunit ; 

end 

for  dd  =  1 : length (r_guess) 

rg_pqw  =  DU* [r_guess (dd) *cos (theta_guess (dd) ) ; r_guess (dd) * 
sin(theta_guess (dd) ) ;0] ; 

[rgi (dd , : ) ]  =  PQW_to_I JK (rg_pqw , [] , inc , RAAN , w) ; 

end 

for  ee  =  1 : length (ang) 

rell_pqw  =  [r_ell (1 , ee) *DU ; r_ell (2,ee)*DU;0]; 
rnom_pqw  =  norm(r0) * [cos (ang (ee) ) ; sin (ang (ee) ) ; 0] ; 
[rell_ijk(:,ee)]  =  PQW_to_I JK (rell_pqw , [] , inc , RAAN , w) ; 
[rnom_i jk (ee , : ) ]  =  PQW_to_I JK (rnom_pqw , [] , inc , RAAN , w) ; 

end 


%%  determine  limits  on  subsequent  passes  into  exclusion  zone 
%  assume  upper  limit  based  on  circular  orbit  with  phi  =  pi/2 
%  assume  lower  limit  based  on  circular  orbit  with  phi  =  2pi/2 
phi_low  =  3*pi/2; 
phi_upp  =  pi/2 ; 

[rf_upp , vf_upp]  =  Single_LT_Limits (rf 1 , vf 1 , phi_upp , ae , be , DU , TU) ; 

[rf 2_upp , vf2_upp , tf 2_upp]  =  zone_entry_exit2 (rf_upp , vf_upp , GMST0 
+0megaEarth* tf 1 , 0 , latlim , longlim) ; 

ang_upp  =  sqrt (MU/norm(rf_upp) " 3) *tf2_upp ; 
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theta£2_max  =  theta_guess (end)  +  ang_upp ; 
t£2_max  =  (t£l  +  t£2_upp)/TU; 


[r£_low , v£_low]  =  Single_LT_Limits (r£l , v£l , phi_low , ae , be , DU , TU) ; 

[r£2_low , v£2_low , t£2_low]  =  zone_entry_exit2 (r£_low , v£_low , GMSTQ 
+0megaEarth* t£l , 0 , latlim , longlim) ; 

ang_low  =  sqrt  CMU/norin(r£_low)  "  3)  *t£2_low  ; 

theta£2_min  =  theta_guess (end)  +  ang_low; 
t£2_min  =  (t£l  +  t£2_low)/TU; 


%%  Second  Maneuver 

[r£2 , v£2 , t£2 , lat_enter2 , long_enter2 , R_exit2 , V_exit2 , t_exit2 , 

lat_exit2 , long_exit2]  =  zone_entry_exi t2 (rt_i jk , vt_ijk , GMST0 
+OmegaEarth* t£l , 0 , latlim , longlim) ; 


T0F2  =  PSO_data(cc  ,  7)  ; 
phi2  =  PSO_data (cc  ,  8)  ; 

Vt_mag2  =  PS0_data (cc  ,  9)  ; 

£pa_t2  =  PS0_data (cc  ,  10)  ; 

[LT_DV2 , maxT2 , r2 , gamma2 , T_a2 , theta£_int2 , theta_dot2 , theta_ddot2 , 
rdot2 ,Tvec2 ,T0F_calc2 ,rt_ijk2 ,vt_ijk2]  =  Single_LT_Maneuver ( 
r£2  ,  v£2  ,  TOF2  ,  phi 2  ,  ae  ,  be  ,  Vt_mag2  ,  £pa_t2  ,  DU  ,  TU  ,  MU2  )  ; 
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theta02  =  theta_guess (end) ; 


delt2  =  (t£2  -  TOF2)/TU; 

time_mod2  =  Tvec2  +  delt2  +  time_guess (end) ; 

[r£_pqw2 , v£_pqw2 ]  =  I JK_to_PQW (r£2 , v£2 , inc , RAAN , w) ; 
r£_pqw2  =  r£_pqw2/DU; 
v£_pqw2  =  v£_pqw2/DU*TU ; 

vunit2  =  v£_pqw2/norm(v£_pqw2) ; 
h£p2  =  cross (r£_pqw2 , v£_pqw2) ; 
hunit2  =  h£p2/norm(h£p2) ; 

gunit2  =  cross (vunit2 , hunit2 ) ; 


%inertial  position  vector  o£  new  arrival  position 
£or  bb  =  1 : length (ang) 

r_ell2(:,bb)  =  r£_pqw2  +  re  (bb)  *cos  (ang  (bb)  ) ''vunit2  +  re(bb) 
''sin(ang  (bb)  )  *gunit2  ; 

end 

[rt_pqw2  ,  vt_pqw2  ]  =  I  JK_to_PQW  (rt_i  jk2  ,  vt_i  jk2  ,  inc  ,  RAAN  ,  w)  ; 
ang_mod2  =  atan2 (rt_pqw2 (2) , rt_pqw2  ( 1) ) ; 
i£  ang_mod2  <  Q 

ang_mod2  =  ang_inod2  +  2*pi; 

end 

ang_modl  =  atan2 (rt_pqw (2) , rt_pqw  (1) ) ; 

di££  =  ang_mod2  -  ang_modl; 

di££2  =  theta£_int2 (end)  -  theta£_int2 (1) ; 

theta_di££  =  di££  -  di££2; 
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theta_inod2  =  theta£_int2  +  theta_dif£  +  theta_guess  (end)  ; 


coast_length  =  1; 

time_guess2  =  zeros (coast_length+length(time_mod2) , 1) ; 
time_guess2 (1 : coast_length)  =  time_guess (end) ; 
time_guess2  (coast_length  +  l :  end)  =  time_inod2  ; 
theta_guess2  =  zeros  ( coas t_l eng th+ length  (the ta_inod2  )  ,  1)  ; 
theta_guess2 (coast_length+l : end)  =  theta_mod2 ; 
theta_guess2 ( 1 : coas t_l eng th)  =  theta02 ; 
r_guess2  =  zeros(coast_length+length(theta_mod2)  ,  1) ; 
r_guess2 (1 : coast_length)  =  r_guess (end) ; 
r_guess2 (coast_length+l : end)  =  r2 ; 

vr_guess2  =  zeros(coast_length+length(theta_mod2) , 1) ; 
vr_guess2 (1 : coast_length)  =  vr_guess (end) ; 
vr_guess2 (coast_length+l : end)  =  rdot2 ; 

vtheta_guess2  =  zeros  (coast_length+length(theta_inod2)  ,  1)  ; 
vtheta_guess2 ( 1 : coas t_l eng th)  =  vtheta_guess (end) ; 
vtheta_guess2 ( coas t_l eng th+1 : end)  =  r2 . * theta_dot2 ; 
T_guess2  =  zeros (coast_length+length (tiine_mod2 )  ,  1)  ; 
T_guess2 (1 : coast_length)  =  ®; 

T_guess2 (coast_length+l : end)  =  T_a2 ; 

B_guess2  =  zeros (coast_length+length (tiine_mod2 )  ,  1)  ; 
B_guess2 (1 : coast_length)  =  B_guess (end) ; 

B_guess2 (coast_length+l : end)  =  gamma2 ; 

ind2  =  £ind (T_guess2  “=  0); 

nom_orb2_time  =  [(0:1: t£2)  t£2]; 

[at , et , it , Ot , ot , nut] =  RV2C0E (rt_i jk , vt_i jk) ; 
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for  ee 


1 : length (nom_orb2_time) 


[nutf]  =  nu£_£rom_T0F (nut , nom_orb2_time (ee) , at , et) ; 
[Rdum( : , ee) , Vdum]  =  C0E2RV (at , et , it , Ot , ot , nutf) ; 
[nom_orb2_R]  =  I  JK_to_PQW(Rduin(  :  ,  ee)  ,  Vdum  ,  inc  ,  RAAN  ,  w)  ; 

R0rb2_PQW (ee , : )  =  nom_orb2_R; 


end 

if  nutf  <  nut 

nutf  =  nutf  +  2*pi; 

end 

%Angle  of  expected  2nd  pass  entry  location  into  exclusion  zone 
theta£2  =  (nutf  -  nut)  +  0; 


%%  GPOPS  RUN  (1st  Run  Through  assigns  a  non-zero  minimum  thrust 
to  help  GPOPS-II  converge) 

%  variables  from  PSo  phase 
rl  =  1; 

r£  =  norm(rt_pqw) ; 
rmax  =  rl  +  be/DU; 
rmin  =  rl  -  be/DU; 

theta£_min  =  theta_rf  -  atan(ae/norm(r6)) )  ; 
theta£_max  =  theta_rf  +  atan(ae/norm(rQ) ) ; 

%  Control  and  time  boundaries 
umin  =  -pi ;  %  minimum  control  angle 
Umax  =  pi ;  %  maximum  control  angle 
Tmax  =  2*®. 0001160; 

Tmin  =  Tmax/1000; 
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uminl 


=  -0.5; 
umin2  =  -0.5; 
umaxl  =  2*pi+0 . 5 ; 
umax2  =  2*pi+0 . 5 ; 

%colocation  points  and  fraction 
colnum  =  4; 
colp  =  40; 

%  GPOPS  Setup 
%  Phase  1  Information 
iphase  =  1; 

limits (iphase) . intervals  =  1; 

limits (iphase) . nodesperint  =  100; 

bounds . phase (iphase) . initialtime . lower  =  t0min; 

bounds . phase (iphase) . initialtime . upper  =  t0max ; 

bounds . phase (iphase) . finaltime . lower  =  tfl/TU; 

bounds . phase (iphase) . finaltime . upper  =  tfl/TU; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rl  theta_rf -n0*tf 1/TU 
0  sqrt(MU2/rl)] ; 

bounds . phase (iphase) . initialstate . upper  =  [rl  theta_rf -n0*tf 1/TU 
0  sqrt (MU2/r 1) ] ; 

bounds . phase (iphase) . finalstate . lower  =  [rmin  thetaf_min  -0.2 
0]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf_max  0.2 
1.2]  ; 

bounds . phase (iphase) . state . lower  =  [rl-0.1  theta_rf -n0*tf 1/TU 
-0.2  0] ; 

bounds . phase (iphase) . state . upper  =  [rl+0.1  thetaf_max  0.2  1.2]; 
bounds . phase (iphase) . control . lower  =  [Tmin  uminl]; 
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bounds . phase (iphase) . control . upper  =  [Tmax  umaxl] ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 
bounds . phase (iphase) . path . lower  =  [] ;  %  None 
bounds . phase (iphase) . path . upper  =  [] ;  %  None 
bounds . phase (iphase) . integral . lower  =  0; 
bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =  [zeros(l,5)  8  8  Rmin/DU  Rmin/ 
DU]  :  %  None 

bounds . eventgroup (iphase) . upper  =  [zeros(l,5)  8  8  Rmax/DU  Rmax/ 
DU]  ;  %  None 
%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  time_guess; 
guess . phase (iphase) . state (:,  1)  =  r_guess; 
guess . phase (iphase) . state (:,  2)  =  theta_guess; 
guess . phase (iphase) . state (:,  3)  =  vr_guess ; 
guess . phase (iphase) . state (:,  4)  =  vtheta_guess ; 

%  Control  guess  ; 

guess . phase (iphase) . control  (:,  1)  =  T_guess ; 
guess . phase (iphase) . control  (:,  2)  =  B_guess ; 
guess . phase (iphase) . integral  =  LT_DV ; 

%  Phase  2  Information  (second  Maneuver 
iphase  =  2; 

limits (iphase) . intervals  =  1; 

limits (iphase) . nodesperint  =  188; 

bounds . phase (iphase) . initialtime . lower  =  tfl/TU; 

bounds . phase (iphase) . initialtime . upper  =  t£l/TU; 

bounds . phase (iphase) . finaltime . lower  =  tf2_min-l; 

bounds . phase (iphase) . finaltime . upper  =  tf2_max+l; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rmin  thetaf_min  -8.2 
8]  ; 
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bounds . phase (iphase) . initialstate . upper  =  [rmax  theta£_max  0.2 

1.2]  : 

bounds . phase (iphase) . finalstate . lower  =  [rmin  thetaf2_min - 1  -0.2 

®]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf2_max+l  0.2 

1.2]  : 

bounds . phase (iphase) . state . lower  =  [rl-0.1  thetaf_min  -0.2  0]; 
bounds . phase (iphase) . state . upper  =  [rl+0.1  thetaf 2_max+l  0.2 

1.2]  : 

bounds . phase (iphase) . control . lower  =  [Tmin  umin2]; 
bounds . phase (iphase) . control . upper  =  [Tmax  umax2]; 
bounds . parameter . lower  =  [00]; 
bounds . parameter . upper  =  [2*pi  2*pi] ; 
bounds . phase (iphase) . path . lower  =  [] ;  %  None 
bounds . phase (iphase) . path . upper  =  [] ;  %  None 
bounds . phase (iphase) . integral . lower  =  0; 
bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =[000  Rmin/DU  Rmin/DU] ;  % 

None 

bounds . eventgroup (iphase) . upper  =[000  Rmax/DU  Rmax/DU] ;  % 

None 

%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  time_guess2 ; 
guess . phase (iphase) . state  (:,  1)  =  r_guess2 ; 
guess . phase (iphase) . state (:,  2)  =  theta_guess2 ; 
guess . phase (iphase) . state (:, 3)  =  vr_guess2 ; 
guess . phase (iphase) . state (:,  4)  =  vtheta_guess2 ; 

%  Control  guess  : 

guess . phase (iphase) . control  (:,  1)  =  T_guess2 ; 
guess . phase (iphase) . control (:,  2)  =  B_guess2 ; 
guess . parameter  =  [phi  phi2]; 

%  guess . parameter  =  [phi]; 
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guess . phase (iphase) .integral  =  LT_DV2 ; 


%auxiliary  data 


auxdata 

MU  =  MU2  ; 

auxdata 

ae  =  ael; 

auxdata 

be  =  bel; 

auxdata 

rf_pqw  =  r£_pqw; 

auxdata 

vunit  =  vunit ; 

auxdata 

gunit  =  gunit ; 

auxdata 

inc  =  inc ; 

auxdata 

RAAN  =  RAAN; 

auxdata.w  =  w 


auxdata , 

.latlim  =  latlim; 

auxdata , 

. longlim  =  longlim; 

auxdata , 

. GMST8  =  GMST8; 

auxdata , 

. OmegaEarth  =  OmegaEarth; 

auxdata , 

.DU  =  DU; 

auxdata , 

H 

II 

H 

%  NOTE: 

Functions  "phasingmaneuverCost "  and  "phasingmaneuverDae" 

required 

rOstring  =  nuin2str  (normCrOvec))  ; 


aestr  = 

num2str (ae) ; 

itstr  = 

num2str (PS0_data (cc , end) ) ; 

tempstr 

=  [aestr  itstr]  ; 

aestring  =  num2str (tempstr) ; 

setup. name  =  [ ’ DoublePass ’  rOstring  aestring]; 

setup . functions . continuous  =  @LT_2RTM_Continuous 
setup . functions . endpoint  =  @LT_2RTM_Endpoint ; 
setup . nip . solver  =  ’ ipopt *  ; 
setup . mesh . maxiteration  =  10; 
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setup . mesh . tolerance  =  le-10; 
setup . mesh . colpointsmin  =  40; 
setup . mesh . colpointsmax  =  400; 


for  ival  =  1:2 

setup . mesh . phase (ival) . colpoints  =  colnum*ones (1 , colp) ; 
setup . mesh . phase (ival) .fraction  =  ( 1/ colp) * ones (1 , colp) ; 

end 

setup. bounds  =  bounds; 

setup. guess  =  guess; 

setup . auxdata  =  auxdata; 

setup . mesh . method  =  ’ RPMintegration ’ ; 

setup . derivatives . supplier  =  ’ sparseFD ’ ; 

setup . derivative level  =  *  second ’ ; 

setup . dependencies  =  ’sparseNaN’; 

setup. scales  =  ’none’; 

output  =  gpops2 ( setup) ; 

solution  =  output . result . solution ; 

%% 

%States  and  costates  from  phase  1  (first  maneuver) 
r_GP0PS_Pl  =  solution . phase (l).state(:,l); 
theta_GPOPS_Pl  =  solution . phase (l).state(:,2); 

Vr_GPOPS_Pl  =  solution . phase (l).state(:,3); 

Vt_GPOPS_Pl  =  solution . phase (1) . state(:  ,4) ; 
lambda_r_Pl  =  solution . phase (1) .cost at e(:  ,1) ; 
lambda_theta_Pl  =  solution . phase (1) .cost at e(:  ,2)  ; 
lambda_Vr_Pl  =  solution . phase (1) .cost at e(:  ,3) ; 
lambda_Vt_Pl  =  solution . phase (1) .cost at e(:  ,4)  ; 
tvec_Pl  =  solution . phase (1) . time ; 

thetadot_GP0PS_Pl  =  Vt_GPOPS_P 1 . /r_GP0PS_P 1 ; 

T_GP0PS_P1  =  solution . phase (1) . control  (  :  , 1) ; 
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Beta_GP0PS_Pl  =  solution . phase (1) . control  (  :  ,2) ; 
phi_GP0PS_Pl  =  solution . parameter  (1) ; 

re_GPOPS_Pl  =  ael ''bel/sqrt  ( (bel*cos  Cphi_GP0PS_Pl)  )  "2  +  (ael ''sin ( 
phi_GP0PS_Pl)) ”2) ; 


% 


%States  and  Costates  from  pahse  2  (second  maneuver) 
r_GP0PS_P2  =  solution . phase (2).state(:,l); 
theta_GP0PS_P2  =  solution . phase (2).state(:,2); 

Vr_GP0PS_P2  =  solution . phase (2).state(:,3); 

Vt_GP0PS_P2  =  solution . phase  (2) . state(:  ,4) ; 
lambda_r_P2  =  solution . phase (2) .cost at e(:  ,1)  ; 
lambda_theta_P2  =  solution . phase  (2) .cost at e(:  ,2)  ; 
lambda_Vr_P2  =  solution . phase (2) .costate(: ,3) ; 
lambda_Vt_P2  =  solution . phase (2) .cost at e(:  ,4) ; 
tvec_P2  =  solution . phase (2) . time ; 

thetadot_GP0PS_P2  =  Vt_GP0PS_P2 . /r_GP0PS_P2 ; 

T_GP0PS_P2  =  solution . phase (2) . control ( :  ,  1) ; 

Beta_GP0PS_P2  =  solution . phase (2) . control ( : ,2) ; 
phi_GP0PS_P2  =  solution . parameter  (2) ; 

re_GP0PS_P2  =  ael -'bel/sqrt  (  (be  1  *cos  Cphi_GP0PS_P2  )  )  "2  +  (ael -'sin  ( 
phi_GP0PS_P2))  ''2)  ; 

% 


Cost  =  (solution . phase (1) . integral  +  solution . phase (2) . integral) 
*DU/TU*1O6)0; 
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%%  GPOPS  Run  two  (Minimum  thrust  is  set  to  zero  in  run  2  to 
generate  true  optimal  solution 
clear  guess  setup  bound  limits 

%colocation  points  and  fraction 
colnum  =  4; 
colp  =  40; 

%  Phase  1  Information 
iphase  =  1; 

limits (iphase) . intervals  =  1; 

limits (iphase) . nodesperint  =  lOQ; 

bounds . phase (iphase) . initialtime . lower  =  tOmin; 

bounds . phase (iphase) . initialtime . upper  =  tOmax ; 

bounds . phase (iphase) . finaltime . lower  =  tfl/TU; 

bounds . phase (iphase) . finaltime . upper  =  tfl/TU; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rl  theta_rf -nO*tf 1/TU 
®  sqrt(MU2/rl)] ; 

bounds . phase (iphase) . initialstate . upper  =  [rl  theta_rf -nQ*tf 1/TU 
8  sqrt(MU2/rl)] ; 

bounds . phase (iphase) . finalstate . lower  =  [rmin  thetaf_min  -8.2 
8]  : 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf_max  8.2 
1.1]  : 

bounds . phase (iphase) . state . lower  =  [rl-8.1  theta_rf -n8*tf 1/TU 
-8.2  8] : 

bounds . phase (iphase) . state . upper  =  [rl+8.1  thetaf_max  8.2  1.1]; 
bounds . phase (iphase) . control . lower  =  [8  uminl] ; 
bounds . phase (iphase) . control . upper  =  [Tmax  umaxl] ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 
bounds . phase (iphase) . path . lower  =  [] ;  %  None 
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bounds . phase (iphase) . path . upper  =  [] ;  %  None 
bounds . phase (iphase) . integral . lower  =  ®; 
bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =  [zeros (1,5)  8  8  Rmin/DU  Rmin/ 
DU]  ;  %  None 

bounds . eventgroup (iphase) . upper  =  [zeros(l,5)  8  8  Rmax/DU  Rmax/ 
DU]  :  %  None 
%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  tvec_Pl; 
guess . phase (iphase) . state (:,  1)  =  r_GP0PS_Pl; 
guess . phase (iphase) . state (:,  2)  =  theta_GP0PS_Pl ; 
guess . phase (iphase) . state (:,  3)  =  Vr_GPOPS_Pl; 
guess . phase (iphase) . state (:,  4)  =  Vt_GPOPS_Pl; 

%  Control  guess  ; 

guess . phase (iphase) . control (:,  1)  =  T_GP0PS_P1; 
guess . phase (iphase) . control (:,  2)  =  Beta_GP0PS_Pl ; 
guess . phase (iphase) . integral  =  LT_DV ; 

%  Phase  2  Information  (second  Maneuver 
iphase  =  2; 

limits (iphase) . intervals  =  1; 

limits (iphase) . nodesperint  =  188; 

bounds . phase (iphase) . initialtime . lower  =  t£l/TU; 

bounds . phase (iphase) . initialtime . upper  =  t£l/TU; 

bounds . phase (iphase) . finaltime . lower  =  t£2_min-l; 

bounds . phase (iphase) . finaltime . upper  =  t£2_max+l; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rmin  theta£_min  -8.2 
®]  ; 

bounds . phase (iphase) . initialstate . upper  =  [rmax  theta£_max  8.2 
1.1]  : 
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bounds . phase (iphase) . finalstate . lower  =  [rmin  thetaf 2_min - 1  -®.2 

®]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf2_max+l  ®.2 
1.1]  : 

bounds . phase (iphase) . state . lower  =  [rl-®.l  thetaf_min  -Q.2  Q] ; 
bounds . phase (iphase) . state . upper  =  [rl+®.l  thetaf 2_max+l  ®.2 
1.1]  : 

bounds . phase (iphase) . control . lower  =  [®  umin2]: 
bounds . phase (iphase) . control . upper  =  [Tmax  umax2]; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 

bounds . parameter . lower  =  [®  ®] ; 

bounds . parameter . upper  =  [2*pi  2*pi] ; 

bounds . phase (iphase) . path . lower  =  [] ;  %  None 

bounds . phase (iphase) . path . upper  =  [] ;  %  None 

bounds . phase (iphase) . integral . lower  =  ®; 

bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =  [0  ®  0  Rmin/DU  Rmin/DU] ;  % 

None 

bounds . eventgroup (iphase) . upper  =  [0  ®  0  Rmax/DU  Rmax/DU] ;  % 

None 

%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  tvec_P2 ; 
guess . phase (iphase) . state (:,  1)  =  r_GP0PS_P2 ; 
guess . phase (iphase) . state (:,  2)  =  theta_GP0PS_P2 ; 
guess . phase (iphase) . state (:,  3)  =  Vr_GPOPS_P2 ; 
guess . phase (iphase) . state (:,  4)  =  Vt_GPOPS_P2 ; 

%  Control  guess  : 

guess . phase (iphase) . control (:,  1)  =  T_GP0PS_P2 ; 
guess . phase (iphase) . control (:,  2)  =  Beta_GP0PS_P2 ; 
guess . parameter  =  [phi_GPOPS_Pl  phi_GP0PS_P2 ] ; 

%  guess . parameter  =  [phi]; 

guess . phase (iphase) . integral  =  Cost; 
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%auxiliary  data 


auxdata 

MU  =  MU2  : 

auxdata 

ae  =  ael; 

auxdata 

be  =  bel; 

auxdata 

rf_pqw  =  r£_pqw; 

auxdata 

vunit  =  vunit ; 

auxdata 

gunit  =  gunit ; 

auxdata 

inc  =  inc ; 

auxdata 

RAAN  =  RAAN; 

auxdata.w  =  w 


auxdata , 

.latlim  =  latlim; 

auxdata , 

. longlim  =  longlim; 

auxdata , 

. GMST8  =  GMST8; 

auxdata , 

. OmegaEarth  =  OmegaEarth; 

auxdata , 

.DU  =  DU; 

auxdata , 

. TU  =  TU; 

%  NOTE: 

Functions  "phasingmaneuverCost "  and  "phasingmaneuverDae" 

required 

rOstring  =  num2str (normCrOvec)) ; 


aestr  = 

num2str (ae) ; 

itstr  = 

num2str (PS0_data (cc , end) ) ; 

tempstr 

=  [aestr  itstr]  ; 

aestring  =  nuin2str  (tempstr)  ; 

setup. name  =  [ ’ DoublePass ’  r®string  aestring]; 

setup . functions . continuous  =  ©LT_2RTM_Continuous 
setup . functions . endpoint  =  @LT_2RTM_Endpoint ; 
setup . nip . solver  =  ’ ipopt *  ; 
setup . mesh . maxiteration  =  10; 
setup . mesh . tolerance  =  le-10; 
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setup . mesh . colpointsmin  =  40; 
setup . mesh . colpointsmax  =  400; 
for  ival  =  1:2 

setup . mesh . phase (ival) . colpoints  =  colnum*ones (1 , colp) ; 
setup . mesh . phase (ival) .fraction  =  ( 1/ colp) * ones (1 , colp) ; 

end 

setup. bounds  =  bounds; 

setup. guess  =  guess; 

setup . auxdata  =  auxdata; 

setup . mesh . method  =  ’ RPMintegration * ; 

setup . derivatives . supplier  =  ’ sparseFD ’ ; 

setup . derivative level  = ’ second ’ ; 

setup . dependencies  =  ’sparseNaN’; 

setup. scales  =  ’none’; 

output  =  gpops2 ( setup) ; 

solution 2  =  output . result . solution ; 

%% 

%States  and  costates  from  phase  1  (first  maneuver) 
r_GP0PS_P12  =  solution2 . phase (l).state(:,l); 
theta_GP0PS_P12  =  solution2 . phase (l).state(:,2); 

Vr_GP0PS_P12  =  solution2 . phase (l).state(:,3); 

Vt_GP0PS_P12  =  solution2 . phase (1) . state(:  ,4) ; 
lambda_r_P12  =  solution2 . phase (l).costate(:,l); 
lambda_theta_P12  =  solution2 . phase (1) .cost at e(:  ,2)  ; 
lambda_Vr_P12  =  solution2 . phase (1) .cost at e(: ,3) ; 
lambda_Vt_P12  =  solution2 . phase (1) .cost at e(:  ,4) ; 
tvec_P12  =  solution 2 . phase (1) . time ; 

thetadot_GP0PS_P12  =  Vt_GP0PS_P12 . /r_GP0PS_P12 ; 

T_GP0PS_P12  =  solution2 . phase (1) . control ( : , 1) ; 

Beta_GP0PS_P12  =  solution2 . phase (1) . control ( :  ,  2) ; 
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indl_large  =  find(Beta_GPOPS_P12  >  2*pi) ; 
indl_small  =  find(Beta_GPOPS_P12  <  0); 

while  isempty (indl_large)  ==  0 

Beta_GP0PS_P12 (indl_large)  =  Beta_GP0PS_P12 (indl_large)  -  2* 
pi : 

indl_large  =  £ind(Beta_GP0PS_P12  >  2*pi); 

end 

while  isempty Cindl_small)  ==  0 

Beta_GP0PS_P12  (indl_small)  =  Beta_GP0PS_P12  Cindl_small)  +  2'' 
pi : 

indl_small  =  £ind(Beta_GP0PS_P12  <  0); 

end 

phi_GP0PS_P12  =  solution2 . parameter (1) ; 

re_GPOPS_P12  =  ael*bel/sqrt ( (be  1  *  cos (phi_GPOPS_P12 ) ) "2  +  (ael * 
sinCphi_GP0PS_P12)) "2) ; 

%States  and  Costates  £rom  pahse  2  (second  maneuver) 
r_GPOPS_P22  =  solution2 . phase (2).state(:,l); 
theta_GPOPS_P22  =  solution2 . phase (2).state(:,2); 

Vr_GPOPS_P22  =  solution2 . phase (2).state(:,3); 

Vt_GPOPS_P22  =  solution2 . phase (2) . state(: ,4) ; 
lambda_r_P22  =  solution2 . phase (2).costate(:,l); 
lambda_theta_P22  =  solution2 . phase (2) .cost at e(: ,2) ; 
lambda_Vr_P2  2  =  solution2 . phase (2) .cost at e(:  ,3) ; 
lambda_Vt_P2  2  =  solution2 . phase (2) .cost at e(:  ,4)  ; 
tvec_P22  =  solution 2 . phase (2) . time ; 

thetadot_GPOPS_P22  =  Vt_GPOPS_P22 . /r_GPOPS_P22 ; 

T_GPOPS_P22  =  solution2 . phase (2) . control ( :  ,  1) ; 
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Beta_GPOPS_P22  =  solution2 . phase (2) . control ( : , 2) ; 


ind2_large  =  f ind (Beta_GPOPS_P22  >  2*pi) ; 
ind2_sinall  =  find(Beta_GPOPS_P22  <  0)  ; 

while  isempty Cind2_large)  ==  0 

Beta_GPOPS_P22  (ind2_large)  =  Beta_GPOPS_P22  Cind2_large)  -  2'' 
pi : 

ind2_large  =  £ind(Beta_GPOPS_P22  >  2*pi) ; 

end 

while  isempty (ind2_small)  ==  0 

Beta_GPOPS_P22  (ind2_small)  =  Beta_GPOPS_P22  Cind2_small)  +  2'' 
pi : 

ind2_small  =  find (Beta_GP0PS_P2 2  <  0); 

end 

phi_GPOPS_P22  =  solution2 . parameter (2) ; 

re_GPOPS_P22  =  ael ''bel/sqrt  (  (be  1  *cos  (phi_GP0PS_P2  2  )  )  ''2  +  (ael* 
sinCphi_GPOPS_P22)) "2) ; 

Cost2  =  (solution2 . phase (1) . integral  +  solution2 . phase (2) . 
integral)  ''DU/TU*  1000 ; 


%% 


% 


%  Determine  entry  condition  for  second  maneuver 

rt  =  [r_GP0PS_P12 (end) *cos (theta_GP0PS_P12 (end) ) ; r_GP0PS_P12 (end 
)*sin(theta_GP0PS_P12 (end)) ;0] ; 
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%apogee  and  perigee  constraints 

V£_mag  =  sqrt  CVr_GP0PS_P12  (end) ''2  +  Vt_GP0PS_P12  (end)  "2)  ; 
fpa  =  atan(Vr_GP0PS_P12 Cend)/Vt_GP0PS_P12 (end)) ; 

%peri focal  velocity 

vt  =  V£_mag * [- sin(theta_GP0PS_P12 (end) -fpa) ; cos (theta_GP0PS_P12 ( 
end)-£pa) ;0] ; 

[rt_i jk_P12 , vt_i jk_P12 ]  =  PQW_to_IJK (rt , vt , inc , RAAN , w) ; 
rt_ijk_P12  =  rt_ijk_P12*DU; 
vt_ijk_P12  =  vt_ijk_P12*DU/TU; 

[r2 , v2 , t2 ]  =  zone_entry_exit2 (rt_i jk_P12 , vt_i jk_P12 , GMST0+ 
0megaEarth*tvec_P12 (end) *TU , 0 , latlim , longlim) ; 

[r£_pqw2 , v£_pqw2 ]  =  I JK_to_PQW (r2 , v2 , inc , RAAN , w) ; 

r£_pqw2  =  r£_pqw2/DU; 
v£_pqw2  =  v£_pqw2 /DU*TU ; 

vunit2  =  v£_pqw2/norm(v£_pqw2) ; 
h£p2  =  cross (r£_pqw2 , v£_pqw2) ; 
hunit2  =  h£p2/norm(h£p2) ; 

gunit2  =  cross (vunit2 , hunit2) ; 

% 


%  for  plotting  purposes  in  PQW  frame 
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% 


terml2  =  (be  1  *  cos (phi_GPOPS_P22 ) ) " 2  +  Cael*sinCphi_GPOPS_P22) ) 
"2; 

re2  =  ael*bel/sqrt (terml2) ; 

rt2  =  r£_pqw2  +  re2 ''cos  Cphi_GP0PS_P2  2  )  *  vunit2  +  re2''sin( 
phi_GPOPS_P22)*gunit2 ; 

for  aa  =  1 : length (ang) 

r_ell2(:,aa)  =  rf_pqw2  +  re  (aa)  *cos  (ang  (aa)  ) ''vunit2  +  re(aa) 
''sin(ang  (aa)  )  ''gunit2  ; 

end 


%First  maneuver  inertial  position  and  velocity 
for  dd  =  1 : length (r_GP0PS_P12 ) 

%perifocal  position  vector 

rg_pqw  =  DU* [r_GP0PS_P12 (dd) *cos (theta_GP0PS_P12 (dd) ) ; 

r_GP0PS_P12 (dd)*sin(theta_GP0PS_P12 (dd)) ;0] ; 

%velocity  magnitude 

Vf_mag  =  sqrt  (Vr_GP0PS_P12  (dd) ''2  +  Vt_GP0PS_P12  (dd)  ”2)  ; 
fpa  =  atan(Vr_GP0PS_P12 (dd)/Vt_GP0PS_P12 (dd)) ; 

%peri focal  velocity 

vg_pqw  =  DU/TU*Vf_mag  * [ -  sin ( theta_GP0PS_P 12 (dd) -fpa) ; cos ( 
theta_GP0PS_P12 (dd) -fpa) ;0] ; 

[rgi  (dd  ,  :  )  ,  vgi  (dd  ,  :  )  ]  =  PQW_to_I  JK  (rg_pqw  ,  vg_pqw  ,  inc  ,  RAAN  ,  w) 


end 
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%  actual  arrival  in  exclusion  zone  location  at  t£l 


[lat_act_enter , long_act_enter ]  =  I JK_to_LATL0NG (rgi (end ,1) , rgi ( 
end ,2) , rgi (end , 3) , GMSTO+OmegaEarth*tf 1 , 0) ; 
figure  (1) 

plot  (long_act_enter'' 180/pi  ,  lat_act_enter*  180/pi  ,  ’  bO  ’  ) 

%expected  arrival  condition  in  exclusion  zone  at  t£2 
[r£2exp , v£2exp , t£2exp , lat_enter2exp , long_enter2exp]  = 

zone_entry_exit2 (rgi (end , : ) , vgi (end , : ) , GMSTO+OmegaEarth*(t£l 
) , to , latlim , longlim) ; 

plot (long_ent er 2  exp* 180/pi , lat_enter 2 exp* 180/pi , ’ rO ’ ) 

%Second  maneuver  inertial  position  and  velocity2 
for  dd  =  1 : length(r_GPOPS_P22) 

%peri£ocal  position  vector 

rg_pqw2  =  DU* [ r_GP0PS_P2 2 (dd) *cos (theta_GPOPS_P22 (dd) ) ; 
r_GPOPS_P22 (dd)*sin(theta_GPOPS_P22 (dd)) ;0] ; 

%velocity  magnitude  and  flight  path  angle 

V£_mag  =  sqrt  (Vr_GPOPS_P22  (dd)  ”2  +  Vt_GPOPS_P22  (dd) ''2)  ; 

fpa  =  atan(Vr_GPOPS_P22 (dd)/Vt_GPOPS_P22 (dd)) ; 

%peri focal  velocity 

vg_pqw2  =  DU/TU* V£_mag * [- sin (theta_GPOPS_P22 (dd) -fpa) ; cos ( 
theta_GPOPS_P22 (dd) -fpa) ;0] ; 

[rgi2(dd,:),vgi2(dd,:)]  =  PQW_to_I JK (rg_pqw2 , vg_pqw2 , inc , 
RAAN ,w) ; 


end 
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%  actual  arrival  in  exclusion  zone  location  at  tf2 


[lat_act_enter2 , long_act_enter2 ]  =  I JK_to_LATL0NG (rgi2 (end , 1) , 
rgi2 (end ,2) , rgi2 (end , 3) , GMSTO+OmegaEarth*(t£l+tf2exp) ,®) ; 
figure (1) 

plot (long_act_enter2*18Q/pi,lat_act_enter2* 180/pi, ’bO’) 

% 

%  [a2 , e2 , i2 , 02 , o2 , nu2 ] =  RV2C0E (rgi2 (end , : ) , vgi2 (end  ,  :  ) )  ; 


%save  optimal  path  in  structure 

optans2 . ics  =  struct (’ rO rOvec vO vOvec tO tO ae ae  be  ’ 
be , ’ Rmax ’ , Rmax , ’ Rmin ’ , Rmin , ’ latlim ’ , latlim , ’ longlim ’ , longlim 
, ’GUSTO ’ ,GMST0 , . . . 

’ inc ’ , inc , ’ RAAN ’ , RAAN , ’ w ’ , w , ’ ang ’ , ang) ; 
optans2 . scale  =  struct ( ’ TU ’  , TU , ’ DU ’ , DU ,  ’ MU  ’  ,  MU2 ) ; 
optans2 . entry (1)  =  struct (’ lat_enter lat_enter long_enter ’ , 
long_enter , ’ r_ell ’ , r_ell , ’ rti jk ’ , rgi (end , : ) , ’ vti jk ’ , vgi (end 
, : ) , ’ rt_pqw ’ , rg_pqw , ’ rf_pqw ’ , rf_pqw , . . . 

’ lat_act_enter ’ , lat_act_enter , ’ long_act_enter ’ , 
long_act_enter , ’r£l’ ,r£l, ’v£l’ ,v£l, ’t£l’ ,t£l); 
optans2 . entry (2)  =  struct (’ lat_enter lat_enter2exp long_enter 
, long_enter2exp , ’ r_ell ’ ,r_ell2 , ’rtijk’ ,rgi2 (end , : ) , ’ vti jk ’ , 
vgi2 (end , : ) , ’ rt_pqw ’ , rg_pqw2 , ’ r£_pqw ’ , r£_pqw2 , . . . 

’ lat_act_enter ’ , lat_act_enter2 , ’ long_act_enter  ’  , 

long_act_enter2 , ’r£l’ ,r£2exp, ’v£l’ ,v£2exp, ’t£l’ ,t£2exp); 
optans2 . phase (1)  =  struct (’ state solution2 . phase (1) . state , ’ 
costate’ ,solution2. phase (1) .costate , ’ control ’ , solution2 . 
phase ( 1) . control , ’ time ’ , tvec_P12 , ’rgi ’ ,rgi) ; 
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optans2 . phase (2)  =  struct (’ state solution2 . phase (2) . state , ’ 
costate’ ,solution2. phase (2) .costate , ’ control ’ , solution2 . 


phase (2) . control , ’ time ’ , tvec_P22 , ’rgi ’ ,rgi2) ; 
optans2 . parameter  =  solution2 . parameter ; 

rOstring  =  num2str (normCrOvec)) ; 
aestr  =  num2str(ae): 
itstr  =  num2str (PS0_data (cc , end) ) ; 
tempstr  =  [aestr  itstr]  ; 
aestring  =  num2str (tempstr)  ; 

dir  =  ’C:\Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTMX 
Double  Pass\Images\ ’ ; 

dir2  =  ’C:\Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Double  Pass\Data\’; 

tend  =  toc(tstart); 

exflag  =  output . result . nlpinfo ; 

fid2  =  fopenC ’ C : \Users\Dan  Showalter\Documents\MATLAB\Low  Thrust 
RTM\ Double  Pass\Data\PS02GP0PSDoublePassDataB . txt ’ , ’ a ’ ) ; 

fprintf (£id2 , ’%i\t  %i\t  %4.3f\t  %4.3f\t  %4.3f\t  %4 . 3 £\t%6 . 5 f \t 
%6.5£\t  %6.5£\t  %6.2£\t  %i\r\n’,... 

norm(rO) , ae , phi , phi_GP0PS_P12 , phi2 , phi_GPOPS_P22 , PS0_data (cc 
,13),Cost,Cost2, tend , ex flag) ; 

£id3  =  fopenC ’ C : \Users\Dan  Showalter\Documents\MATLAB\Low  Thrust 
RTM\Double  Pass\Data\DoublePassCostB . txt ’ , ’ a ’ ) ; 

£print£(£id3 , ’%i\t  %i  \t  %4.3£\t  %4.3£\t  %4.3£\t  %i\t\r\n ’ , . . . 
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norm(r0)  ,  ae  ,  solution2  .  phase  (1)  .  integral  *DU/TU*  1000  ,  solution2 


.  phase  (2)  .  integral*DU/TU''1000  ,  Cost2  ,  exflag)  ; 


if  exflag  ==  0 
%plot  optimal  results 

[op tout]  =  LT_D0UBLE_PASS_PL0TS (optans2 , rOstring , aestring , dir) ; 

dataname  =  [ * DoublePass *  rOstring  aestring]; 

%save  data 

save (strcat(dir2 , [dataname] ) , ’ output ’ ) ; 
end 

clear  optans 
close  all 

end 

end 

£',2,2,2  Double  Pass  LTRTM  Equations  of  Motion  and  Cost  Function 

function  phaseout  =  LT_2RTM_Continuous (input) 

%%  Phase  1 

si  =  input . phase (1) . state ; 
ul  =  input . phase (1) . control ; 

%  Equations  of  Motion 
% 
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rl  =  si  (  :  ,  1)  : 
vrl  =  slC:  ,  3)  : 
vthetal  =  si ( :  ,  4) ; 

T1  =  ulC:  ,  1)  : 

B1  =  ul(:  ,2)  : 

MU2  =  input . auxdata . MU : 

r_dotl  =  vrl; 
theta_dotl  =  vthetal. /rl; 

vr_dotl  =  (vthetal  .  ■'2)  ./rl  -  MU2  . /(rl . ''2)  +  Tl.*sin(Bl); 
vtheta_dotl  =  -vthetal . *vrl . /rl  +  Tl.*cosCBl); 

%  Form  matrix  output 

daeoutl  =  [r_dotl  theta_dotl  vr_dotl  vtheta_dotl]  ; 

phaseout (1) . dynamics  =  daeoutl; 

% 


%  Cost  Function 

phaseout (1) . integrand  =  Tl; 

%%  Phase  2 

s2  =  input . phase (2) . state  ; 
u2  =  input . phase (2) . control ; 

%  Equations  of  Motion 
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% 


r2  =  s2  (:  ,  1)  ; 
vr2  =  s2  (  :  ,  3)  ; 
vtheta2  =  s2 ( :  ,  4) ; 

T2  =  u2(:  ,1); 

B2  =  u2(:  ,2)  ; 

r_dot2  =  vr2 ; 
theta_dot2  =  vtheta2./r2; 

vr_dot2  =  (vtheta2 . "2) ./r2  -  MU2 . / (r2 . " 2)  +  T2.*sin(B2); 
vtheta_dot2  =  -vtheta2 . *vr2 . /r2  +  T2.*cosCB2); 

%  Form  matrix  output 

daeout2  =  [r_dot2  theta_dot2  vr_dot2  vtheta_dot2 ] ; 

phaseout (2) . dynamics  =  daeout2 ; 

% 


%  Cost  Function 

phaseout (2) . integrand  =  T2 ; 

E.2.2.3  Double  Pass  LTRTM  Constraints 

function  output  =  LT_2RTM_Endpoint (input) 


%%  Cost  Function  Evaluation 
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% 


J  =  input . phase (1) . integral  +  input . phase (2) . integral ; 
output . obj ective  =  J; 

% 


%%  Event  Constraints 


%%  Phase  1  (First  Maneuver) 


%pha 

se  2  var 

■iable 

s 

tfl 

=  input . 

phase 

CD 

. £inaltime ; 

xfl 

=  input . 

phase 

CD 

. £inalstate ; 

P  = 

input . paramet 

er ; 

phi 

=  p(i) ; 

%pha 

se  2  var 

■iable 

s 

t02 

=  input . 

phase 

C2) 

. initialtime ; 

tf2 

=  input . 

phase 

C2) 

. £inaltime ; 

x02 

=  input . 

phase 

C2) 

. initialstate 

xf2 

=  input . 

phase 

C2) 

. £inalstate ; 

phi2 

=  P(2)  ; 

r£  = 

xflCD  ; 

thet 

a£  =  x£l 

(2)  ; 

Vrf 

=  x£l(3) 

» 

Vtf 

=  x£l(4) 

» 

ael 

bel 

MU2 


input . auxdata . ae 
input . auxdata . be 
input . auxdata . MU 


%semiinajor  axis  of  exclusion  ellipse 
%  semiminor  axis  of  exclusion  ellipse 
%gravitational  parameter  scaled  by  DU  and  TU 


297 


33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 

61 


r£_pqw  =  input . auxdata . r£_pqw ;  %  peri£ocal  position  vector  o£  initial 
corssing  into  exclusion  zone 

vunit  =  input . auxdata . vunit ;  %peri£ocal  unit  velocity  vector  o£  initial 
crossing  into  exclusion  zone 

gunit  =  input . auxdata . gunit ;  %peri£ocal  unit  vetcor  o£  initial  crossing 
into  exclusion  zone 

terml  =  (bel ''cos (phi) )  ”2  +  (ael*sin(phi))  "2  ; 

re  =  ael*bel/sqrt (terml) ; 

rt  =  r£_pqw  +  re -'cos  (phi ) -'vunit  +  re''sin(phi) -'gunit ; 

%£inal  position  constraints 
eventl  =  r£*cos ( theta£)  -  rt(l); 
event2  =  r£*sin(theta£)  -  rt(2); 

%velocity  magnitude  and  £light  path  angle 
V£_mag  =  sqrt(Vr£''2  +  Vt£''2); 

£pa  =  atan(Vr£/Vt£) ; 

%peri£ocal  velocity 

vt  =  V£_mag*[-sin(theta£-£pa) ; cos (theta£-£pa) ;0] ; 

[a, ecc =  RV2C0E_MU(rt ,vt,MU2) ; 

Ra  =  a*(l+ecc); 

Rp  =  a*(l-ecc) ; 

events  =  Ra ; 
event4  =  Rp ; 

%  Linkage  Constraints 
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event l_link_state  =  x02  -  x£l; 
event l_link_time  =  tQ2  -  tfl; 

output . event group (1) . event  =  [event l_link_st ate  event l_li nk_ time  event  1 
event2  events  event4] ; 

%%  Phase  2  (Second  Maneuver) 

%  constant  variables 

inc  =  input . auxdata . inc ;  %inclination  of  initial  orbit  (used  to  convert 
everything  into  perifocal  frame  of  initial  orbit) 

RAAN  =  input . auxdata . RAAN ;  %RAAN  of  initial  orbit  (used  to  convert 
everything  into  perifocal  frame  of  initial  orbit) 
w  =  input . auxdata . w ;  %argument  of  perigee  of  initial  orbit  (used  to 
convert  everything  into  perifocal  frame  of  initial  orbit) 
latlim  =  input . auxdata . latlim ; 
longlim  =  input . auxdata . longlim ; 

GMSTO  =  input . auxdata . GMSTO ; 

OmegaEarth  =  input . auxdata . OmegaEarth ; 

DU  =  input . auxdata . DU ; 

TU  =  input . auxdata . TU ; 


rf2  =  xf 2 (1) ; 
thetaf 2  =  xf2 (2) ; 

Vrf2  =  xf2(3)  ; 

Vtf2  =  xf2(4)  ; 

%position  and  velocity  of  initial  intercept  in  perifocal  frame  of 
initial 
%orbit 
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i£  isnan(r£)  ==  1  | |  isnan ( theta£)  ==  1  | |  isnan(V£_mag)  ==  1  | |  isnan( 


tfl)  ==  1  1 1 

isnan(phi)  ==  1 

event2 1 

=  NaN; 

event22 

=  NaN; 

event2  5 

=  NaN; 

event2  3 

=  NaN; 

event24 

=  NaN; 

else 

[rt_i jk , vt_i jk] 

=  PQW_to_IJK (rt , vt , inc , RAAN , w) 

rt_ijk  =  rt_ijk 

*DU; 

vt_ijk  =  vt_ijk*DU/TU; 


[r2,v2,t2]  =  zone_entry_exit2 (rt_i jk , vt_i jk , GMSTO+OmegaEarth* t£l *TU , 0 , 
latlim , longlim) ; 

[r£_pqw2 , v£_pqw2 ]  =  IJK_to_PQW (r2 , v2 , inc , RAAN , w) ; 

r£_pqw2  =  r£_pqw2/DU; 
v£_pqw2  =  v£_pqw2/DU*TU ; 

vunit2  =  v£_pqw2/norinCv£_pqw2)  ; 
h£p2  =  cross (r£_pqw2 , v£_pqw2) ; 
hunit2  =  h£p2/norm(h£p2) ; 

gunit2  =  cross (vunit2 , hunit2 ) ; 

terml2  =  (be  1 ''cos  (phi2  )  )  " 2  +  (ael*sin(phi2)  ) ''2  ; 
re2  =  ael*bel/sqrt (terml2) ; 

rt2  =  r£_pqw2  +  re2 *cos (phi2 ) * vuni t2  +  re2*sinCphi2)*gunit2 ; 

%£inal  position  constraints 
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event21  =  rf2*cos(thetaf2)  -  rt2(l); 
event22  =  rf2 ''sin(thetaf2)  -  rt2C2); 

%apogee  and  perigee  constraints 
V£_mag2  =  sqrt(Vr£2''2  +  Vt£2''2); 

£pa2  =  atanCVr£2/Vt£2) ; 

%peri£ocal  velocity 

vt2  =  V£_mag2 * [- sin (theta£2 - £pa2 ) ; cos (theta £2  - £pa2) ; 0] ; 

[a2 , ecc2 =  RV2C0E_MU (rt2 , vt2 , MU2 ) ; 

Ra2  =  a2*(l+ecc2) ; 

Rp2  =  a2 ''(l-ecc2)  ; 

event2  3  =  Ra2 ; 
event24  =  Rp2 ; 

event25  =  t£2  -  (t£l  +  t2/TU) ; 
end 

output . eventgroup (2) . event  =  [event21  event22  event25  event23  event24] ; 

E.3  Triple  Pass  LTRTMs 

E.3.1  Particle  Swarm  Algorithms 

E.3. 1.1  Triple  Pass  LTRTM  PSO  Driver 

wgs84data 
global  MU 

OmegaEarth  =  (9.0(3(8072921151467; 

for  bb  =  10 : 10 

to  =  0; 
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GMST®  =  0; 

latlim  =  [-10  10]*pi/180; 
longlim  =  [-50  -10]*pi/180; 

rOvec  =  [7300 ; 0 ; 0] ; 

vOvec  =  sqrt (MU/norm(rOvec) ) * [0 ; 1/sqrt (2) ; 1/sqrt (2) ] ; 

[a , ecc , inc , RAAN , w ,  nuO]  =  RV2C0E (rOvec , vOvec)  ; 
period  =  2*pi*sqrt(a''3/MU)  ; 

aevec  =  [150  140  130  120  110  100  90  80  70  60  50]; 
bevec  =  [15  14  13  12  1 1  10  9  8  7  6  5]  ; 

Rmaxvec  =  norm(r0vec)+50 ; 

Rminvec  =  norm(rOvec)  -  50; 

DU  =  norm(rOvec) ; 

TU  =  period/(2*pi)  ; 

MU2  =  MU*TU''2/DU''3 ; 

mO  =  1000; 
rO  =  rOvec; 
vO  =  vOvec; 

Rmax  =  Rmaxvec ; 

Rmin  =  Rminvec ; 

%Energy  o£  most  elliptical  orbit 

ab  =  (Rmax  +  Rmin)/2;  %semi-major  axis  of  orbit 

Eb  =  -MU/(2*ab);  %energy  of  orbit 

Vmax  =  sqrt (2* (MU/Rmin  +  Eb)); 

Vmin  =  sqrt (2* (MU/Rmax  +  Eb)); 

fid  =  fopen  C [dir  *  PS0DoublePassDataFinal_060120 14 . txt ’ ] , ’ a ’ ) ; 
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state0= [rO  vO] ; 


Tmax  = 

2e-3: 

swarm  = 

40; 

iter  = 

1000; 

prec  = 

[5;5;5;9] 

if  bb  ==  1 


£print£(£id , *%s  %i\r\n’,’rO  (km)  = * , rOvec  (1) )  ; 

£print£(£id , *  %s  %i\r\n ’ , *  swarm  = ’ , swarm) ; 

£print£(£id , *%s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t  % 
s\t  %s\t  %s\t  %s\t  %s\t  %s\t  %s\t\r\n ’  ,  ’ TOP ’ , *  Phi ’  ,  ’ V£ ’ , * £pa 
’ , *T0F2’  ,  ’Phi2* ,  ’ V£2 ’ , ’ £pa2 ’  ,  ’DV’ , ’DV2’  ,  ’ DVTOT ’ ,  ’iter’  ,  ’ 
iter 2  ’  ,  ’ iterTOT ’  ,  ’ time ’ , ’ time2 ’ , ’ timeTOT ’ ) ; 

£print£(£id, ’%s\r\n’ , ’ 


’); 

end 

if  bb  ==  IQ 

endval  =  1 ; 

else 

endval  =  2Q; 

end 

ae  =  aevec (bb)  ; 
be  =  bevec (bb) ; 

[rfl ,v£l ,t£l , lat_enter , long_enter , R_exit , V_exit , t_exit , lat_exit , 
long_exit ]  =  zone_entry_exit2 (rQ , vQ , GMSTQ , tQ , latlim , longlim) ; 
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for  aa 


1 : endval 


tstart  =  tic ; 

[  JGmin  ,  Jpbest  ,  gbest  ,  X  ,  k]  =  LT_RTM_PSO_TFIXED  (3  ,  [0  2*pi;Vinin  Vmax 
;-pi/2+Q.®QO0Ol  pi/2-Q. OQ00O1] , iter , swarm , prec , r£l , v£l , t£l , 
ae  ,  be  ,  DU  ,  TU  ,  MU  ,  Rmax  ,  Rmin  ,  Tmax  ,  mO)  ; 

Costl  =  3Gmin*DU/TU"lO0O 

tend  =  toc(tstart) 

tstart2  =  tic ; 

rt_i jk , vt_i jk]  =  Single_LT_Maneuver (r£l , 
v£l  ,  t£l  ,  gbest  ( 1)  ,  ae  ,  be  ,  gbest  (2)  ,  gbest  (3)  ,  DU  ,  TU  ,  MU2  )  ; 

[r£2 , v£2 , t£2]  =  zone_entry_exit2 (rt_i jk , vt_i jk , GMST0+OmegaEarth* 
t£l , 0 , latlim , longlim) ; 

[JGmin2 , Jpbest2 ,gbest2 ,x2,k2]  =  LT_RTM_PSO_TFIXED (3 , [0  2*pi;Vmin 
Vmax pi /2 +0.00 00 01  pi/2-0. 000001] , iter , swarm , prec , r£2 , v£2 , 
t£2  ,  ae  ,  be  ,  DU  ,  TU  ,  MU  ,  Rmax  ,  Rmin  ,  Tmax  ,  m0)  ; 

Cost2  =  3Gmin2*DU/TU*1000 

CostTOT  =  Costl  +  Cost2 

tend2  =  toc(tstart2) 
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fprintf (fid , ’%i\t  %i  \t  %10.5f\t  %6.5f\t  %7.6f\t  %6.5£\t  %10.5f\ 
t  %6.5f\t  %7.6f\t  %6.5£\t  %7.6£\t  %7.6£\t  %7.6£\t  %i\t  %i\t 


%i\t  %4.1£\t  %4.1£\t  %4. l£\r\n’  ,  . . . 

norm(rO) ,ae,t£l ,gbest(l) ,gbest(2) ,gbest(3)  ,t£2  ,gbest2(l)  , 
gbest2(2),gbest2(3),Costl,Cost2,CostTOT,k,k2,k+k2, tend , 
tend2 , tend+tend2) ; 
tend  +  tend2 

clear  tstart  JGmin  Jpbest  gbest  x  k  Costl  tend  tstart2  rt_ijk 
vt_ijk  r£2  v£2  t£2  JGmin2  Jpbest2  gbest2  x2  k2  Cost2 
CostTOT  tend2 

end 


end 

E.3.2  Direct  Collocation  Algorithms 
E.3.2.1  Triple  Pass  LTRTM  Driver 

for  zz  =  2:2 

clear  guess  setup  limits  output 

close  all 

clc 

if  zz  ==  1 

loadC ’ C : \Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Triple  Pass\Journal  Data\data6800_LT_3RTMsort . mat ’ ) 

[ind®]  =  £indCdata6800_LT_3RTMsort ( : , 1)  0); 

PS0_data  =  data68Q®_LT_3RTMsort (ind®  ,  :  )  ; 
cmax  =  67 ; 
cmin  =  67 ; 
rmag  =  68®®; 
elseif  zz  ==  2 
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load (’C:\Users\D an  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 


Triple  Pass\ Journal  Data\data7 30O_LT_3RTMsort . mat ’ ) 
[indO]  =  £indCdata73O0_LT_3RTMsort ( :  ,  1)  “=  0); 

PS0_data  =  data7  300_LT_3RTMsort (ind0  ,  : )  ; 
cmax  =  27 ; 
cmin  =  22 ; 
rmag  =  7300; 

end 

for  cc  =  cmin: cmax 

fid  =  fopen(*PSO_to_GPOPS_3RTM4.txt^  ’a’) ; 
clear  guess  setup  limits  output 
close  all 
clc 

t0  =  0; 

GMST0  =  0; 

latlim  =  [-10  10]''pi/180; 
longlim  =  [-50  -10]*pi/180; 

wgs84data 
global  MU2  MU 

OmegaEarth  =  0.000072921151467; 
r0vec  =  [rmag;0;0]; 

v0vec  =  sqrt  CMU/norm(r0vec) ) * [0 ; 1/sqrt (2) ; l/sqrt(2)] ; 

[a  ,  ecc  ,  inc  ,  RAAN  ,  w  ,  nu0]  =  RV2C0E  (r0vec  ,  v0vec)  ; 
period  =  2*pi*sqrt (a'l/MU) ; 

swarm  =  30; 
iter  =  1000; 

Rmaxvec  =  rmag  +  50; 

Rminvec  =  rmag  -  50; 
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rO  =  rOvec ; 
vO  =  vQvec ; 

Rmax  =  Rmaxvec; 

Rmin  =  Rminvec; 

ae  =  PSO_data  (cc  ,  2)  ; 
be  =  ae/10; 

TOP  =  PSO_data(cc  ,  3)  ; 
phi  =  PSO_data (cc  ,  4) ; 

Vt_mag  =  PSO_data (cc  ,  5)  ; 

£pa_t  =  PSO_data (cc , 6) ; 

tstart  =  tic ; 

[rf 1 , v£l , t£l , lat_enter , long_enter , R_exit , V_exit , t_exit  ,  lat_exit  , 
long_exit]  =  zone_entry_exi t2 (r0 , vO , GMSTO , t0 , latlim , longlim) 


lat_exp_enter  =  lat_enter; 
long_exp_enter  =  long_enter; 

DU  =  norm(r£l) ; 

TU  =  period/(2*pi); 


ael  = 

ae/DU; 

bel  = 

be/DU; 

r81  = 

norm(rQ)/DU ; 

MU2  = 

MU*TU''2/DU"3: 

tQmin 

=  Q;  %  minimum 

initial  time 

tQmax 

=  ®;  %  maximum 

initial  time 
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tfmin  =  t£l;  %  minimum  final  time 
tfmax  =  t£l ; 

nO  =  sqrt (MU2/(norm(rO)/DU) "B) ; 


%%  First  Maneuver 

[LT_DV  ,  maxT  ,  r  ,  gamma  ,  T_a  ,  theta£_int  ,  theta_dot  ,  theta_ddot  ,  rdot  , 
Tvec  ,  T0F_calc  ,  rt_i  jk  ,  vt_i  jk  ,  rt_pqw  ,  vt_pqw  ,  rO_pqw  ,  vO_pqw]  = 
Single_LT_Maneuver (rfl , v£l , t£l , phi , ae , be , Vt_mag , £pa_t , DU , TU , 
MU2)  ; 

time_mod  =  Tvec; 

[r£_pqw , v£_pqw]  =  I JK_to_PQW (rfl , v£l , inc , RAAN , w) ; 
r£_pqw  =  r£_pqw/DU; 
v£_pqw  =  v£_pqw/DU''TU ; 


vunit  =  v£_pqw/norm ( v£_pqw) ; 
h£p  =  cross (r£_pqw , v£_pqw) ; 
hunit  =  h£p/normCh£p) ; 

gunit  =  cross (vunit , hunit) ; 

ang  =  (0 : 0 . 001 : 2*pi) ; 

re  =  (ael*bel)  ./sqrt  CCbel''cos(ang))  . ''2  +  (ael*sin(ang))  . ''2)  ; 


theta_r£  =  atan2 (r£_pqw (2) , r£_pqw (1) ) ; 
if  theta_r£  <  0 

theta_r£  =  2*pi  +  theta_r£; 

end 

[rtest ]  =  I JK_to_PQW (r0 , v0 , inc , RAAN  ,  w)  ; 
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theta©  =  atan2 (rtest (2) ,rtest(l))  ; 


theta_mod  =  theta£_int  +  atan2 (r©_pqw (2) , rQ_pqw ( 1) ) ; 

time_guess  =  time_mod; 
theta_guess  =  theta_mod; 
r_guess  =  r; 
vr_guess  =  rdot; 
vtheta_guess  =  r . * theta_dot ; 

T_guess  =  T_a ; 

B_guess  =  gamma; 

ind  =  £ind(T_guess  “=  ©) ; 

%inertial  position  vector  o£  new  arrival  position 
£or  aa  =  1 : length (ang) 

r_ellC:,aa)  =  r£_pqw  +  re  (aa)  *cos  (ang  (aa)  )  *vunit  +  re(aa)'' 
sin  (ang  (aa)  )  -'gunit ; 

end 

rgi  =  zeros (length(r_guess)  ,  3) ; 

£or  dd  =  1 : length (r_guess) 

rg_pqw  =  DU* [r_guess (dd) *cos (theta_guess (dd) ) ; r_guess (dd) * 
sin(theta_guess (dd) ) ;©] ; 

[rgi (dd , : ) ]  =  PQW_to_I3K (rg_pqw ,  []  , inc , RAAN , w) ; 

end 

£or  ee  =  1 : length (ang) 

rell_pqw  =  [r_ell (1 , ee) *DU ; r_ell (2,ee)*DU;Q]; 
rnom_pqw  =  norm(r©) * [cos (ang (ee) ) ; sin (ang (ee) ) ; ©] ; 
[rell_ijk(:,ee)]  =  PQW_to_I JK (rell_pqw , [] , inc , RAAN , w) ; 
[rnom_i jk (ee , : ) ]  =  PQW_to_I JK (rnom_pqw , [] , inc , RAAN , w) ; 
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end 


%%  determine  limits  on  subsequent  passes  into  exclusion  zone 
%  assume  upper  limit  based  on  circular  orbit  with  phi  =  pi/2 
%  assume  lower  limit  based  on  circular  orbit  with  phi  =  2pi/2 
phi_low  =  3''pi/2; 
phi_upp  =  pi/2 ; 

[r£_upp , vf_upp]  =  Single_LT_Limits (r£l , v£l , phi_upp , ae , be , DU , TU) ; 

[r£2_upp , v£2_upp , t£2_upp]  =  zone_entry_exit2 (r£_upp , v£_upp , GMSTO 
+OmegaEarth* t£l , 0 , latlim , longlim) ; 

ang_upp  =  sqrt (MU/norm(r£_upp) " 3) *t£2_upp ; 

theta£2_max  =  theta_guess (end)  +  ang_upp ; 
t£2_max  =  (t£l  +  t£2_upp)/TU; 


[r£_low , v£_low]  =  Single_LT_Limits (r£l , v£l , phi_low , ae , be , DU , TU) ; 

[r£2_low , v£2_low , t£2_low]  =  zone_entry_exit2 (r£_low , v£_low , GMSTO 
+OmegaEarth*t£l , 0 , latlim , longlim) ; 

ang_low  =  sqrt  CMU/norm(r£_low) " 3) *t£2_low ; 

theta£2_min  =  theta_guess (end)  +  ang_low; 
t£2_min  =  (t£l  +  t£2_low)/TU; 
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%%  Second  Maneuver 


[rf2 , v£2 , t£2 , lat_enter2 , long_enter2 , R_exit2 , V_exit2 , t_exit2 , 

lat_exit2 , long_exit2]  =  zone_entry_exi t2 (rt_i jk , vt_ijk , GMST0 
+OmegaEarth*t£l , 0 , latlim , longlim) ; 


T0F2  =  PSO_data(cc  ,  7)  ; 
phi2  =  PS0_data (cc  ,  8)  ; 

Vt_mag2  =  PS0_data (cc  ,  9)  ; 

£pa_t2  =  PS0_data (cc  ,  10)  ; 

[LT_DV2 , maxT2 , r2 , gamma2 , T_a2 , theta£_int2 , theta_dot2 , theta_ddot2 , 
rdot2 ,Tvec2 ,T0F_calc2 ,rt_ijk2 ,vt_ijk2]  =  Single_LT_Maneuver ( 
r£2 , v£2 , t£2 , phi 2 , ae , be , Vt_mag2 , £pa_t2 , DU , TU , MU2) ; 

theta02  =  theta_guess (end) ; 

delt2  =  (t£2  -  T0F2)/TU; 

time_mod2  =  Tvec2  +  time_guess (end)  +  delt2 ; 

[r£_pqw2 , v£_pqw2 ]  =  I JK_to_PQW (r£2 , v£2 , inc , RAAN , w) ; 
r£_pqw2  =  r£_pqw2/DU; 
v£_pqw2  =  v£_pqw2 /DU*TU ; 

vunit2  =  v£_pqw2/norm(v£_pqw2) ; 
h£p2  =  cross (r£_pqw2 , v£_pqw2 ) ; 
hunit2  =  h£p2/norm(h£p2) ; 

gunit2  =  cross (vunit2 , hunit2) ; 

[rt_pqw2 , vt_pqw2 ]  =  I JK_to_PQW (rt_i jk2 , vt_i jk2 , inc , RAAN , w) ; 
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ang_mod2  =  atan2 (rt_pqw2 (2) , rt_pqw2  ( 1) ) ; 
while  ang_mod2  <  theta_guess (end) 
ang_mod2  =  ang_inod2  +  2*pi; 

end 

ang_modl  =  atan2 (rt_pqw (2) , rt_pqw  (1) ) ; 

di££  =  ang_mod2  -  ang_modl; 

di££2  =  theta£_int2 (end)  -  theta£_int2 (1) ; 

theta_di££  =  di££  -  di££2; 


%inertial  position  vector  o£  new  arrival  position 
£or  bb  =  1 : length (ang) 

r_ell2(:,bb)  =  r£_pqw2  +  re  (bb)  *cos  (ang  (bb)  ) ''vunit2  +  re(bb) 
*sin(ang  (bb)  )  ''gunit2  ; 

end 

theta_inod2  =  theta£_int2  +  theta_di££  +  theta_guess  (end)  ; 

coast_length  =  1; 

time_guess2  =  zeros(coast_length+length(time_mod2) , 1) ; 
time_guess2 (1 : coast_length)  =  time_guess (end) ; 
time_guess2  (coast_length  +  l :  end)  =  time_inod2  ; 
theta_guess2  =  zeros ( c oas t_l eng th+ length (the ta_mod2 )  ,  1) ; 
theta_guess2 (coast_length+l : end)  =  theta_mod2 ; 
theta_guess2 ( 1 : coast_length)  =  theta02 ; 
r_guess2  =  zeros(coast_length+length(theta_mod2) , 1) ; 
r_guess2 (1 : coast_length)  =  r_guess (end) ; 
r_guess2 (coast_length+l : end)  =  r2 ; 

vr_guess2  =  zeros(coast_length+length(theta_mod2)  ,  1) ; 
vr_guess2 (1 : coast_length)  =  vr_guess (end) ; 
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vr_guess2 (coast_length+l : end)  =  rdot2 ; 

vtheta_guess2  =  zeros  (coast_length+length(theta_inod2)  ,  1)  ; 
vtheta_guess2 (1 : coast_length)  =  vtheta_guess (end) ; 
vtheta_guess2 (coast_length+l : end)  =  r2 . * theta_dot2 ; 
T_guess2  =  zeros (coast_length+length (tiine_mod2 )  ,  1)  ; 
T_guess2 (1 : coast_length)  =  0; 

T_guess2 (coast_length+l : end)  =  T_a2 ; 

B_guess2  =  zeros (coast_length+length Ctiine_mod2 )  ,  1)  ; 
B_guess2 (1 : coast_length)  =  B_guess (end) ; 

B_guess2  (coast_length  +  l :  end)  =  gainma2  ; 

ind2  =  find (T_guess2  “=  0); 

nom_orb2_time  =  [(0:1: tf2)  t£2]; 

[at , et , it , Ot , ot , nut ] =  RV2C0E (rt_i jk , vt_i jk) ; 

for  ee  =  1 : length (nom_orb2_time) 

[nutf  ]  =  nuf_from_T0F  (nut ,  nom_orb2_tiine  (ee)  ,  at ,  et)  ; 
[Rdum(  :  ,  ee)  ,  Vdum]  =  C0E2RV  (at ,  et ,  it ,  Ot ,  ot ,  nutf)  ; 
[nom_orb2_R]  =  I JK_to_PQW(Rdum(  :  , ee) , Vdum , inc , RAAN  ,  w)  ; 

R0rb2_PQW  (ee  ,  :  )  =  nom_orb2_R; 


end 

while  nutf  <  nut 

nutf  =  nutf  +  2*pi; 

end 

%Angle  of  expected  2nd  pass  entry  location  into  exclusion  zone 
thetaf2  =  (nutf  -  nut)  +  0; 
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%%  Coasting  phase 

%inodify  angle  to  match  scenario  angle 

%1)  determine  coes  of  post  maneuver  2  orbit  at  t  =  time_guess2( 
end) 

[at 2  ,  et2  ,  it2 , 0t2  ,  ot2  ,  nut 2  ]  =  RV2C0E  (rt_i  jk2  ,  vt_i  jk2)  ; 

tcoastS  =  [(time_guess2  Cend)  +  .Q01 : . 1 : time_guess2 (end) +  Ct_exit2 - 
t£2)/TU) ’ ; time_guess2 (end)+(t_exit2 -t£2)/TU] ; 
coast_length  =  length(tcoast3) ; 
time_guess3  =  tcoast3; 
r_guess3  =  zeros (coast_length  ,  1)  ; 
theta_guess3  =  zeros (coast_length  ,  1)  ; 
vr_guess3  =  zeros (coast_length  ,  1)  ; 
vtheta_guess3  =  zeros (coast_length  ,  1)  ; 

T_guess3  =  zeros (coast_length  ,  1)  ; 

Beta_guess3  =  zeros (coast_length  ,  1)  ; 

for  yy  =  1 : coast_length 

if  yy  ==  1 

tprev  =  time_guess2 (end) ; 
angprev  =  theta_guess2 (end) ; 
nu_prev  =  nut2  ; 

end 

%2)  determine  length  of  time  step  in  seconds 
tstep  =  (tcoastS (yy) -tprev) *TU ; 

%3)  current  time  becomes  previous  time 
tprev  =  tcoastS (yy); 

%4)  determine  angle  traveled  during  tstep 
angnew  =  nuf_from_T0F (nu_prev , tstep , at2 , et2)  ; 

if  angnew  <  nu_prev 

angtemp  =  angnew+2*pi; 
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else 


angtemp  =  angnew; 

end 

ang_di£f  =  angtemp  -  nu_prev; 
theta_guess3 (yy)  =  angprev+ang_dif £ ; 
angprev  =  theta_guess3 (yy) ; 
nu_prev  =  angnew ; 

%5)  determine  position  and  velocity  in  UK 

[r3i  jk  ,  v3i  jk]  =  C0E2RV  (at 2  ,  et2  ,  it2 , 0t2  ,  ot2  ,  angnew)  ; 

%6)  convert  position  and  velocity  to  peri£ocal  £rame  o£ 
initial 
%orbit 

[r3pqw  ,  v3pqw]  =  UK_to_PQW (r3i  jk  ,  v3i  jk  ,  inc  ,  RAAN  ,  w)  ; 

r_guess3(yy)  =  norm(r3pqw) /DU ; 

%  7)  Vr  and  Vtheta 

vr_guess3  (yy)  =  (MU/at2*(l-et2''2))*et2  *  sin  (angnew)  /DU''TU ; 
vtheta_guess3  (yy)  =  sqrt  (MU/at2  *  (1  -  et2  ''2))*(l  +  et2  *  cos  (angnew 
))/DU^^TU; 

T_guess(yy)  =  Q; 

Beta_guess (yy)  =  0; 

i£  yy  ==  coast_length 

tend!  =  tcoast  3  (yy) ''TU  ; 
rend3  =  r3ijk; 
vend3  =  v3ijk; 

theta3end  =  theta_guess3 (yy) ; 

end 


end 
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%%  Third  Maneuver 


[rf4 , v£4 , t£4 , lat_enter3 , long_enter 3 , R_exit3 , V_exit3 , t_exit3 , 
lat_exit 3 , long_exit 3 ]  =  zone_entry_exi t2 (rend 3 , vend 3 , GMST0+ 
0megaEarth*(t£l+t_exit2) ,0 , latlim , longlim) ; 
i£  t£4  <  period+500 

T0F3  =  PS0_data(cc  ,  11)  ; 
phi3  =  PS0_data  (cc  ,  12)  ; 

Vt_mag3  =  PS0_data (cc  ,  13)  ; 

£pa_t3  =  PS0_data  (cc  ,  14)  ; 

[LT_DV3 , maxT3 , r3 , gamma 3 , T_a3 , theta£_int3 , theta_dot3 , 

theta_ddot 3 , rdot3 , Tvec3 , T0F_calc3 , rt_i jk3 , vt_i jk3 ]  = 
Single_LT_Maneuver (r£4 , v£4 , t£4 , phi  3 , ae , be , Vt_mag3 , £pa_t3 
,DU,TU,MU2) ; 

theta04  =  theta_guess3 (end) ; 

delt4  =  (t£4  -  T0F3)/TU; 

time_mod4  =  Tvec3  +  time_guess3 (end)  +  delt4; 

[r£_pqw4 , v£_pqw4]  =  I3K_to_PQW (r£4 , v£4 , inc , RAAN , w) ; 
r£_pqw4  =  r£_pqw4/DU; 
v£_pqw4  =  v£_pqw4/DU*TU ; 

vunit4  =  v£_pqw4/norm(v£_pqw4) ; 
h£p4  =  cross (r£_pqw4 , v£_pqw4) ; 
hunit4  =  h£p4/norm(h£p4) ; 

gunit4  =  cross (vunit4 , hunit4) ; 

[rt_pqw4 , vt_pqw4]  =  I3K_to_PQW (rt_i jk3 , vt_i jk3 , inc , RAAN , w) ; 
ang_mod4  =  atan2 (rt_pqw4 (2) , rt_pqw4 (1) ) ; 
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while  ang_mod4  <  ® 

ang_mod4  =  ang_mod4  +  2''pi; 

end 


di££31  =  ang_mod4  -  ang_mod2 ; 

di££32  =  theta£_int3 (end)  -  theta£_int3 (1) ; 

theta_di££3  =  di££31  -  di££32 ; 

%inertial  position  vector  o£  new  arrival  position 
£or  zz  =  1 : length (ang) 

r_ell4(:,zz)  =  r£_pqw4  +  re  (zz) -'cos  (ang  (zz)  )  *  vunit4  + 
(zz)  *sin(ang  (zz)  )  ''gunit4  ; 

end 

theta_mod4  =  theta£_int3  +  theta_di££3  +  theta_guess2 (end) 
while  theta_mod4 (1)  <  theta_guess3 (end) 
theta_mod4  =  theta_inod4  +  2*pi; 

end 

i£  theta_mod4  (2)  -  theta04  >  0.1 

theta_mod4  =  theta_mod4  -  2''pi; 

end 

coast_length  =  1; 

time_guess4  =  zeros (coast_length  +  length (time_inod4)  ,  1)  ; 
time_guess4 ( 1 : coast_length)  =  time_guess3 (end) ; 
time_guess4 (coast_length+l : end)  =  time_mod4 ; 
theta_guess4  =  zeros (coast_length  +  length(theta_mod4)  ,  1) ; 
the t a_gue s s4 (coast _1 eng th+1 : end)  =  theta_mod4 ; 
theta_guess4 (1 : coast_length)  =  theta04 ; 
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r_guess4  =  zeros (coast_length+length(theta_mod4)  ,  1) ; 
r_guess4 ( 1 : coast_length)  =  r_guess3 (end) ; 
r_guess4 (coast_length+l : end)  =  r3 ; 

vr_guess4  =  zeros  ( co as t_l eng th+ length  (the ta_inod4)  ,  1)  ; 
vr_guess4 (1 : coast_length)  =  vr_guess3 (end) ; 
vr_guess4 (coast_length+l : end)  =  rdot3 ; 

vtheta_guess4  =  zeros (coast_length+length(theta_mod4) , 1) ; 
vtheta_guess4 (1 ; coast_length)  =  vtheta_guess3 (end) ; 
vtheta_guess4 (coast_length+l : end)  =  r3 . *theta_dot3 ; 

T_guess4  =  zeros (coast_length+length(time_mod4)  ,  1) ; 

T_guess4 ( 1 : coast_length)  =  0; 

T_guess4 (coast_length+l : end)  =  T_a3 ; 

B_guess4  =  zeros (coast_length+length (time_mod4) , 1) ; 

B_guess4 ( 1 : coast_length)  =  0; 

B_guess4 (coast_length+l : end)  =  gamma 3 ; 

nom_orb3_time  =  [(0:l:t£4)  t£4] ; 

[at 2  ,  et2  ,  it2 , 0t2  ,  ot2  ,  nut2  ]  =  RV2C0E  (rt_i  jk2  ,  vt_i  jk2  )  ; 

£or  yy  =  1 : length (nom_orb3_time) 

[nut£2]  =  nu£_£rom_T0F (nut2 , nom_orb3_time (yy) , at2 , et2) ; 
[Rdum2 ( : , yy) , Vdum2 ]  =  C0E2RV (at 2 , et2 , it2 , 0t2 , ot2 , nut £2 ) ; 
[nom_orb3_R]  =  I JK_to_PQW (Rdum2 ( : , yy) , Vdum2 , inc , RAAN , w) ; 

R0rb3_PQW (ee  ,  : )  =  nom_orb3_R; 


end 

else 

T0F3  =  period; 

phi3  =  PS0_data (cc , 12) ; 

Vt_mag3  =  PS0_data (cc , 13) ; 
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fpa_t3  =  PSO_data  (cc  ,  14)  ; 


[LT_DV3 , maxT3 , r3 , gamma 3 , T_a3 , theta£_int3 , theta_dot3 , 

theta_ddot3 ,rdot3 ,Tvec3 ,T0F_calc3 ,rt_ijk3 ,vt_ijk3]  = 
Single_LT_Maneuver (r£4 , v£4 , TOF3 , phi 3 , ae , be , Vt_mag3 , 
£pa_t3 ,DU,TU,MU2) ; 


tcoast4  =  (time_guess3 (end) + . 0® 1 : . 1 : time_guess3 (end) +(t£4 - 
period)/TU) ; 

time_mod4  =  time_guess3 (end) +(t£4 -period) /TU  +  Tvec3; 
coast_length4  =  length(tcoast4) ; 

%modi£y  time  to  match  scenario  time 

time_guess4  =  zeros (coast_length4+length(time_mod4) , 1) ; 
time_guess4 ( 1 : coast_length4)  =  tcoast4; 
time_guess4 (coast_length4+l : end)  =  time_mod4 ; 

r_guess4  =  zeros (length(time_guess4) , 1) ; 
theta_guess4  =  zeros (length (time_guess4)  ,  1) ; 
vr_guess4  =  zeros ( length (time_guess4) , 1) ; 
vtheta_guess4  =  zeros (length (time_guess4) , 1) ; 

T_guess4  =  zeros ( length (time_guess4) , 1) ; 

Beta_guess4  =  zeros (length (time_guess4) , 1) ; 

%modi£y  angle  to  match  scenario  angle 
%1)  determine  coes  o£  post  maneuver  2  orbit  at  t  = 
time_guess2 (end) 

[at 2  ,  et2  ,  it2 , 0t2  ,  ot2  ,  nut2  ]  =  RV2C0E  (rend 3  ,  vend 3)  ; 

£or  yy  =  1 : coast_length4 
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if  yy  ==  1 

tprev  =  time_guess3 (end) ; 
angprev  =  theta_guess3 (end) ; 
nu_prev  =  nut2 ; 

end 

%2)  determine  length  of  time  step  in  seconds 
tstep  =  Ctcoast4 (yy) -tprev) *TU : 

%3)  current  time  becomes  previous  time 
tprev  =  tcoast4(yy); 

%4)  determine  angle  traveled  during  tstep 
angnew  =  nuf_from_T0F (nu_prev , tstep , at2 , et2 ) ; 

if  angnew  <  nu_prev 

angtemp  =  angnew+2*pi ; 

else 

angtemp  =  angnew; 

end 

ang_diff  =  angtemp  -  nu_prev; 
theta_guess4 (yy)  =  angprev+ang_diff ; 
angprev  =  theta_guess4 (yy) ; 
nu_prev  =  angnew; 

%5)  determine  position  and  velocity  in  I3K 
[r3ijk ,v3ijk]=COE2RV(at2 ,et2 ,it2 ,0t2 ,ot2 , angnew) ; 

%6)  convert  position  and  velocity  to  perifocal  frame  of 
initial 
%orbit 

[r3pqw , v3pqw]  =  I3K_to_PQW(r3i jk , v3i jk , inc , RAAN , w) ; 

r_guess4(yy)  =  norm(r3pqw)/DU; 

%  7)  Vr  and  Vtheta 
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vr_guess4  (yy)  =  (MU/at2  *  (1  -  et2  ''2)  )  *et2*sin(angnew)  /DU*TU 


vtheta_guess4  (yy)  =  sqrt  (MU/at2*Cl-et2''2))*Cl  +  et2''cos( 
angnew) ) /DU*TU ; 


end 

[r£_pqw4 , v£_pqw4]  =  I JK_to_PQW (r£4 , v£4 , inc , RAAN , w) ; 
r£_pqw4  =  r£_pqw4/DU; 
v£_pqw4  =  v£_pqw4/DU*TU ; 

vunit4  =  v£_pqw4/norm(v£_pqw4) ; 
h£p4  =  cross (r£_pqw4 , v£_pqw4) ; 
hunit4  =  h£p4/norinCh£p4)  ; 

gunit4  =  cross (vunit4 , hunit4) ; 

[rt_pqw4 , vt_pqw4]  =  I JK_to_PQW (rt_i jk3 , vt_i jk3 , inc , RAAN , w) ; 


ang_inod4  =  atan2  (rt_pqw4  (2)  ,  rt_pqw4  (1)  )  ; 
while  ang_mod4  <  theta_guess4 (yy) 
ang_mod4  =  ang_mod4  +  2''pi; 

end 

di££31  =  ang_mod4  -  theta_guess4 (yy) ; 
di££32  =  theta£_int3 (end)  -  theta£_int3 (1) ; 
theta_di££3  =  di££31  -  di££32 ; 


%inertial  position  vector  o£  new  arrival  position 
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for  zz  =  1 : length (ang) 

r_ell4(:,zz)  =  r£_pqw4  +  re  (zz) ''cos  (ang  (zz)  )  *  vunit4  +  re 
(zz)  *  sin  (ang  (zz)  )  ''gunit4  ; 

end 

theta_mod4  =  theta_guess4 (yy)  +  theta£_int3  +  theta_di££3; 

while  theta_mod4 (1)  <  theta_guess4 (yy) 
theta_mod4  =  theta_inod4  +  2*pi; 

end 


time_guess4 (coast_length4+l : end)  =  time_mod4 ; 
theta_guess4 (coast _1 eng th4+l : end)  =  theta_mod4 ; 
r_guess4 (coast_length4+l : end)  =  r3 ; 
vr_guess4 (coast_length4+l : end)  =  rdot3 ; 
vtheta_guess4  (coast_length4  +  l :  end)  =  r3  .  ''theta_dot3  ; 
T_guess4 ( 1 : coast_length4)  =  0; 

T_guess4 (coast_length4+l : end)  =  T_a3 ; 

Beta_guess4 ( 1 : coast_length4)  =  0; 

Beta_guess4 (coast _1 eng th4+l : end)  =  gamma! ; 


end 


%%  GPOPS  RUN  (1st  Run  Through  assigns  a  non-zero  minimum  thrust 
to  help  GPOPS-II  converge) 

%  variables  from  PSo  phase 
rl  =  1; 

rf  =  norm(rt_pqw) ; 
rmax  =  rl  +  be/DU; 
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rmin  =  rl  -  be/DU; 

thetaf_min  =  theta_rf  -  atan(ae/norm(r8) ) ; 
thetaf_max  =  theta_rf  +  atan(ae/norm(r8) )  ; 


%  Control  and  time  boundaries 
umin  =  -8.5;  %  minimum  control  angle 

Umax  =  2*pi+8.5:  %  maximum  control  angle 

Tmax  =  2*8.8881168; 

Tmin  =  Tmax/1888; 

% 


%  GPOPS  Setup 
%  Phase  1  Information 
iphase  =  1; 

bounds . phase (iphase) . initialtime . lower  =  t8min; 
bounds . phase (iphase) . initialtime . upper  =  t8max ; 
bounds . phase (iphase) . finaltime . lower  =  tfl/TU; 
bounds . phase (iphase) . finaltime . upper  =  tfl/TU; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rl  theta_rf -n8*tf 1/TU 
8  sqrt(MU2/rl)] ; 

bounds . phase (iphase) . initialstate . upper  =  [rl  theta_rf -n8*tf 1/TU 
8  sqrt (MU2/r 1) ] ; 

bounds . phase (iphase) . finalstate . lower  =  [rmin  thetaf_min  -8.1 

Q]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf_max  8.1 

1.1]  : 

bounds . phase (iphase) . state . lower  =  [rmin  theta_rf -n8*tf 1/TU  -8.1 
8]  ; 

bounds . phase (iphase) . state . upper  =  [rmax  thetaf_max  8.1  1.1]; 
bounds . phase (iphase) . control . lower  =  [Tmin  umin]; 
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bounds . phase (iphase) . control . upper  =  [Tmax  umax]  ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 
bounds . phase (iphase) . path . lower  =  [] ;  %  None 
bounds . phase (iphase) . path . upper  =  [] ;  %  None 
bounds . phase (iphase) . integral . lower  =  0; 
bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =  [zeros(l,5)  8  8  Rmin/DU  Rmin/ 
DU]  :  %  None 

bounds . eventgroup (iphase) . upper  =  [zeros(l,5)  8  8  Rmax/DU  Rmax/ 
DU]  ;  %  None 
%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  time_guess; 
guess . phase (iphase) . state (:,  1)  =  r_guess; 
guess . phase (iphase) . state (:,  2)  =  theta_guess; 
guess . phase (iphase) . state (:,  3)  =  vr_guess ; 
guess . phase (iphase) . state (:,  4)  =  vtheta_guess ; 

%  Control  guess  ; 

guess . phase (iphase) . control  (:,  1)  =  T_guess ; 
guess . phase (iphase) . control  (:,  2)  =  B_guess ; 
guess . phase (iphase) . integral  =  LT_DV ; 

% 


%  Phase  2  Information  (second  Maneuver 
iphase  =  2; 

bounds . phase (iphase) . initialtime . lower  =  tfl/TU; 
bounds . phase (iphase) . initialtime . upper  =  t£l/TU; 
bounds . phase (iphase) . finaltime . lower  =  tf2_min-l; 
bounds . phase (iphase) . finaltime . upper  =  tf2_max+l; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rmin  thetaf_min  -8.1 
8]  ; 
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bounds . phase (iphase) . initialstate . upper  =  [rmax  theta£_max  0.1 
1.1]  : 

bounds . phase (iphase) . finalstate . lower  =  [rmin  thetaf2_min - 1  -0.1 

®]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf2_max+l  0.1 
1.1]  : 

bounds . phase (iphase) . state . lower  =  [rmin  thetaf_min  -0.1  0]; 
bounds . phase (iphase) . state . upper  =  [rmax  theta£2_max+l  0.1  1.1]; 
bounds . phase (iphase) . control . lower  =  [Tmin  umin] ; 
bounds . phase (iphase) . control . upper  =  [Tmax  umax]  ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 
bounds . phase (iphase) . path . lower  =  [] ;  %  None 
bounds . phase (iphase) . path . upper  =  [] ;  %  None 
bounds . phase (iphase) . integral . lower  =  0; 
bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =  [zeros(l,5)  000  Rmin/DU  Rmin 
/DU]  ;  %  None 

bounds . eventgroup (iphase) . upper  =  [zeros(l,5)  000  Rmax/DU  Rmax 
/DU]  ;  %  None 
%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  time_guess2 ; 
guess . phase (iphase) . state (:,  1)  =  r_guess2 ; 
guess . phase (iphase) . state (:,  2)  =  theta_guess2 ; 
guess . phase (iphase) . state (:, 3)  =  vr_guess2 ; 
guess . phase (iphase) . state (:,  4)  =  vtheta_guess2 ; 

%  Control  guess  ; 

guess . phase (iphase) . control  (:,  1)  =  T_guess2 ; 
guess . phase (iphase) . control  (:,  2)  =  B_guess2 ; 
guess . phase (iphase) . integral  =  LT_DV2  ; 

% 
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%  Phase  3  (Coast) 
iphase  =  3; 

bounds . phase (iphase) . initialtime . lower  =  tf2_min-l; 
bounds . phase (iphase) . initialtime . upper  =  tf2_max+l; 
bounds . phase (iphase) . finaltime . lower  =  tcoast3 (end) - 1 ; 
bounds . phase (iphase) . finaltime . upper  =  tcoast3 (end) +1 ; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rmin  thetaf 2_min - 1 
-0.1  0] : 

bounds . phase (iphase) . initialstate . upper  =  [rmax  thetaf2_max+l 
0.1  1.1] : 

bounds . phase (iphase) . finalstate . lower  =  [rmin  theta3end-l  -0.1 
0]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  theta3end+l  0.1 
1.1]  : 

bounds . phase (iphase) . state . lower  =  [rmin  thetaf2_min - 1  -0.1  0] ; 
bounds . phase (iphase) . state . upper  =  [rmax  theta3end+l  0.1  1.1]; 
bounds . phase (iphase) . control . lower  =  [00]; 
bounds . phase (iphase) . control . upper  =  [00]; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 
bounds . phase (iphase) . path . lower  =  [] ;  %  None 
bounds . phase (iphase) . path . upper  =  [] ;  %  None 
bounds . phase (iphase) . integral . lower  =  0; 
bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =  [zeros(l,5)  0];  %  None 
bounds . eventgroup (iphase) . upper  =  [zeros(l,5)  0];  %  None 
%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  time_guess3; 
guess . phase (iphase) . state (:, 1)  =  r_guess3 ; 
guess . phase (iphase) . state (:,  2)  =  theta_guess3 ; 
guess . phase (iphase) . state (:,  3)  =  vr_guess3 ; 
guess . phase (iphase) . state (:,  4)  =  vtheta_guess3 ; 
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%  Control  guess  : 

guess  .  phase (iphase) . control  (:,  1)  =  T_guess3 ; 
guess . phase (iphase) . control  (:,  2)  =  Beta_guess3 ; 
guess . phase (iphase) . integral  =  0; 

%  Phase  4  Information  (third  Maneuver) 
iphase  =  4; 

bounds . phase (iphase) . initialtime . lower  =  tcoast3 (end)  - 1 ; 
bounds . phase (iphase) . initialtime . upper  =  tcoast3 (end) +1 ; 
bounds . phase (iphase) . finaltime . lower  =  (tfl+tf2+tf4)/TU-l ; 
bounds . phase (iphase) . finaltime . upper  =  (tf l+tf2+tf4)/TU+l ; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rmin  theta3end-l  -0.1 
0]  ; 

bounds . phase (iphase) . initialstate . upper  =  [rmax  theta3end+l  0.1 
1.1]  : 

bounds . phase (iphase) . finalstate . lower  =  [rmin  theta_guess4 (end) 
-1  -0.1  0] ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  theta_guess4 (end) 
+1  0.1  1.1]; 

bounds . phase (iphase) . state . lower  =  [rmin  theta3end-l  -0.1  0]; 
bounds . phase (iphase) . state . upper  =  [rmax  theta_guess4 (end) +1  0.1 
1.1] ; 

bounds . phase (iphase) . control . lower  =  [Tmin  umin] ; 
bounds . phase (iphase) . control . upper  =  [Tmax  umax] ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 

bounds . parameter . lower  =  [000]; 

bounds . parameter . upper  =  [2*pi  2*pi  2*pi] ; 

bounds . phase (iphase) . path . lower  =  [] ;  %  None 

bounds . phase (iphase) . path . upper  =  [] ;  %  None 

bounds . phase (iphase) . integral . lower  =  0; 

bounds . phase (iphase) . integral . upper  =  1; 
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bounds . eventgroup (iphase) . lower  =[000  Rmin/DU  Rmin/DU] ;  % 


None 

bounds . eventgroup (iphase) . upper  =[000  Rmax/DU  Rmax/DU] ;  % 
None 

%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  time_guess4; 
guess . phase (iphase) . state (:,  1)  =  r_guess4; 
guess . phase (iphase) . state (:,  2)  =  theta_guess4 ; 
guess . phase (iphase) . state (:,  3)  =  vr_guess4; 
guess . phase (iphase) . state (:,  4)  =  vtheta_guess4 ; 

%  Control  guess  : 

guess  .  phase (iphase) . control  (:,  1)  =  T_guess4; 
guess . phase (iphase) . control  (:,  2)  =  Beta_guess4 ; 
guess . parameter  =  [phi  phi2  phi3] ; 
guess . phase (iphase) . integral  =  LT_DV3 ; 

% 


%auxiliary  data 

auxdata.MU  =  MU2 ; 

auxdata.ae  =  ael; 

auxdata.be  =  bel; 

auxdata . rf_pqw  =  r£_pqw; 

auxdata . vunit  =  vunit ; 

auxdata . gunit  =  gunit ; 

auxdata. inc  =  inc  ; 

auxdata. RAAN  =  RAAN ; 

auxdata. w  =  w; 

auxdata . latlim  =  latlim; 

auxdata . longlim  =  longlim; 

auxdata. GMSTO  =  GMSTO ; 

auxdata . OmegaEarth  =  OmegaEarth; 
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auxdata.DU  =  DU; 
auxdata.TU  =  TU ; 

%  NOTE:  Functions  " phasingmaneuverCost "  and  "phasingmaneuverDae" 
required 

setup. name  =  ’ TIME_FIXED_INTERCEPT ^ 


colp  =  4; 
colnum  =  2®; 
colp2  =  4; 
colnum2  =  80; 

setup . functions . continuous  =  ©LT_3RTM_Continuous_4Phase ; 
setup . functions . endpoint  =  ©LT_3RTM_Endpoint_4Phase ; 
setup . nip . solver  =  ’ ipopt *  ; 
setup . mesh . maxiteration  =  10; 
setup . mesh . tolerance  =  le-10; 
setup . mesh . colpointsmin  =  40; 
setup . mesh . colpointsmax  =  1000; 
for  i  =  1:4 
if  i  <  4 

setup . mesh . phase (i).colpoints  =  colp* ones (1 , colnum) ; 
setup . mesh . phase (i) . fraction  =  1/ colnum* ones (1 , colnum) ; 
elseif  i  ==  3 

setup . mesh . phase (i) .colpoints  =  l*ones (1,5) ; 
setup . mesh . phase (i) . fraction  =  1/5* ones (1,5) ; 

else 

setup . mesh . phase (i). colpoints  =  colp 2  *ones (1 , colnum2 ) ; 
setup . mesh . phase (i) . fraction  =  l/colnum2  * ones (1 , colnum2) 


end 
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end 


setup. bounds  =  bounds; 

setup. guess  =  guess; 

setup . auxdata  =  auxdata; 

setup . mesh . method  =  ’ RPMintegration * ; 

setup . derivatives . supplier  =  ’ sparseFD ’ ; 

setup . derivative level  = ’ second ’ ; 

setup . dependencies  =  ’sparseNaN’; 

setup. scales  =  ’none’; 

output  =  gpops2 ( setup) ; 

solution  =  output . result . solution ; 

%% 

%States  and  costates  from  phase  1  (first  maneuver) 
r_GP0PS_Pl  =  solution . phase (l).state(:,l); 
theta_GP0PS_Pl  =  solution . phase  Cl).state(:,2); 

Vr_GPOPS_Pl  =  solution . phase (l).state(:,3); 

Vt_GP0PS_Pl  =  solution . phase (1) . state(:  ,4) ; 
lambda_r_Pl  =  solution . phase (1) .cost at e(: ,1) ; 
lambda_theta_Pl  =  solution . phase  (1) .cost at e(:  ,2) ; 
lambda_Vr_Pl  =  solution . phase (1) .costate(:  ,3)  ; 
lambda_Vt_Pl  =  solution . phase  (1) .costate(:  ,4) ; 
tvec_Pl  =  solution . phase ( 1) . time ; 

thetadot_GPOPS_Pl  =  Vt_GP0PS_P 1 . /r_GP0PS_P 1 ; 

T_GP0PS_P1  =  solution . phase (1) . control ( :  ,  1) ; 

Beta_GP0PS_Pl  =  solution . phase (1) . control ( : ,2) ; 
phi_GP0PS_Pl  =  solution . parameter  (1) ; 

re_GPOPS_Pl  =  ael ''bel/sqrt  ( (bel*cos  Cphi_GP0PS_Pl)  )  "2  +  (ael ''sin ( 
phi_GP0PS_Pl))  ''2)  ; 


330 


742 

743 

744 

745 

746 

747 

748 

749 

750 

751 

752 

753 

754 

755 

756 

757 

758 

759 

760 

761 

762 

763 

764 

765 

766 


switch_£uncl  =  lambda_Vr_Pl .  *sin(Beta_GPOPS_Pl)  +  lainbda_Vt_Pl  .  * 
cosCBeta_GPOPS_Pl)  +  1; 


% 


%States  and  Costates  from  phase  2  (second  maneuver) 
r_GP0PS_P2  =  solution . phase (2).state(:,l); 
theta_GP0PS_P2  =  solution . phase (2).state(:,2); 

Vr_GP0PS_P2  =  solution . phase  (2).state(:,3); 

Vt_GP0PS_P2  =  solution . phase (2) . state(: ,4) ; 
lambda_r_P2  =  solution . phase (2) .cost at e(:  ,1)  ; 
lambda_theta_P2  =  solution . phase  (2) .cost at e(:  ,2) ; 
lambda_Vr_P2  =  solution . phase (2) .cost at e(:  ,3)  ; 
lambda_Vt_P2  =  solution . phase  (2) .costate(:  ,4) ; 
tvec_P2  =  solution . phase (2) . time ; 

thetadot_GP0PS_P2  =  Vt_GP0PS_P2 . /r_GP0PS_P2 ; 

T_GP0PS_P2  =  solution . phase (2) . control ( :  ,  1) ; 

Beta_GP0PS_P2  =  solution . phase (2) . control ( : ,2) ; 
phi_GP0PS_P2  =  solution . parameter  (2) ; 

re_GP0PS_P2  =  ael*bel/sqrt  (  (be  1  *cos  Cphi_GP0PS_P2  )  )  "2  +  (ael -'sin  ( 
phi_GP0PS_P2)) ”2) ; 

switch_£unc2  =  lambda_Vr_P2  .  *  sin  (Beta_GP0PS_P2  )  +  lambda_Vt_P2  .  '' 
cos(Beta_GP0PS_P2)  +  1; 

% 


%States  and  Costates  from  phase  3  (third  maneuver) 
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r_GP0PS_P3  =  solution . phase (3).state(:,l); 
theta_GP0PS_P3  =  solution . phase (3).state(:,2); 

Vr_GP0PS_P3  =  solution . phase (3).state(:,3); 

Vt_GP0PS_P3  =  solution . phase (3) . state(: ,4) ; 
lambda_r_P3  =  solution . phase (3) .cost at e(:  ,1)  ; 
lambda_theta_P3  =  solution . phase (3) .cost at e(: ,2) ; 
lambda_Vr_P3  =  solution . phase (3) .costate(:  ,3)  ; 
lambda_Vt_P3  =  solution . phase (3) .costate(: ,4) ; 
tvec_P3  =  solution . phase (3) . time ; 

thetadot_GP0PS_P3  =  Vt_GP0PS_P3 . /r_GP0PS_P3 ; 

T_GP0PS_P3  =  solution . phase (3) . control  (  :  ,  1) ; 

Beta_GP0PS_P3  =  solution . phase (3) . control  (  :  ,2)  ; 
phi_GP0PS_P3  =  solution . parameter (3) ; 

re_GP0PS_P3  =  ael*bel/sqrt  ( (bel*cos  Cphi_GP0PS_P3)  )  "2  +  (ael -'sin ( 
phi_GP0PS_P3))  ''2)  ; 

switch_£unc3  =  lambda_Vr_P3 . *sin(Beta_GP0PS_P3)  +  lambda_Vt_P3 . * 
cosCBeta_GP0PS_P3)  +  1; 

%States  and  Costates  from  phase  3  (third  maneuver) 
r_GP0PS_P4  =  solution . phase (4).state(:,l); 
theta_GP0PS_P4  =  solution . phase (4).state(:,2); 

Vr_GP0PS_P4  =  solution . phase (4).state(:,3); 

Vt_GP0PS_P4  =  solution . phase (4) . state(:  ,4) ; 
lambda_r_P4  =  solution . phase (4) .cost at e(: ,1) ; 
lambda_theta_P4  =  solution . phase (4) .cost at e(:  ,2)  ; 
lambda_Vr_P4  =  solution . phase (4) .cost at e(: ,3) ; 
lambda_Vt_P4  =  solution . phase (4) .costate(:  ,4)  ; 
tvec_P4  =  solution . phase (4) . time ; 

thetadot_GP0PS_P4  =  Vt_GP0PS_P4 . /r_GP0PS_P4 ; 
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T_GP0PS_P4  =  solution . phase (4) . control ( :  ,  1) ; 

Beta_GP0PS_P4  =  solution . phase (4) . control  (  :  ,2)  ; 

re_GPOPS_P4  =  ael ''bel/sqrt  (  (bel*cos  Cphi_GP0PS_P3)  )  "2  +  (ael ''sin  ( 
phi_GP0PS_P3)) ”2) ; 

switch_£unc4  =  lambda_Vr_P4  .  *  sin  (Beta_GP0PS_P4)  +  lainbda_Vt_P4  .  * 
cos CBeta_GP0PS_P4)  +  1; 


% 


Cost  =  (solution . phase (1) . integral  +  solution . phase (2) . integral 
+  solution . phase (3). integral  +  solution . phase (4) .integral) * 
DU/TU^IOOO 

%%  GPOPS  Run  two  (Minimum  thrust  is  set  to  zero  in  run  2  to 
generate  true  optimal  solution 
clear  guess  setup  bound  limits 

%  variables  from  PSo  phase 
rl  =  1; 

rmax  =  rl  +  be/DU; 
rmin  =  rl  -  be/DU; 

theta£_min  =  theta_r£  -  atan(ae/norm(r0) ) ; 
theta£_max  =  theta_r£  +  atan(ae/norm(r0)) ; 

%  Control  and  time  boundaries 
umin  =  -0.5;  %  minimum  control  angle 

Umax  =  2''pi+0.5;  %  maximum  control  angle 

Tmax  =  2*0.0001160; 

%  Tmin  =  0; 

%  Phase  1  Information 
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iphase  =  1; 

bounds . phase (iphase) . initialtime . lower  =  tOmin; 
bounds . phase (iphase) . initialtime . upper  =  tOmax ; 
bounds . phase (iphase) . finaltime . lower  =  tfl/TU; 
bounds . phase (iphase) . finaltime . upper  =  tfl/TU; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rl  theta_rf -nQ*tf 1/TU 
8  sqrt(MU2/rl)] ; 

bounds . phase (iphase) . initialstate . upper  =  [rl  theta_rf -n8*tf 1/TU 
8  sqrt(MU2/rl)] ; 

bounds . phase (iphase) . finalstate . lower  =  [rmin  thetaf_min  -8.1 

®]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf_max  8.1 
1.1]  : 

bounds . phase (iphase) . state . lower  =  [rmin  theta_rf -n8*tf 1/TU  -8.1 
8]  ; 

bounds . phase (iphase) . state . upper  =  [rmax  thetaf_max  8.1  1.1]; 
bounds . phase (iphase) . control . lower  =  [Tmin  umin] ; 
bounds . phase (iphase) . control . upper  =  [Tmax  umax] ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 
bounds . phase (iphase) . path . lower  =  [] ;  %  None 
bounds . phase (iphase) . path . upper  =  [] ;  %  None 
bounds . phase (iphase) . integral . lower  =  8; 
bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =  [zeros(l,5)  8  8  Rmin/DU  Rmin/ 
DU]  :  %  None 

bounds . eventgroup (iphase) . upper  =  [zeros(l,5)  8  8  Rmax/DU  Rmax/ 
DU]  ;  %  None 
%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  tvec_Pl; 

guess . phase (iphase) . state (:,  1)  =  r_GP0PS_Pl; 

guess . phase (iphase) . state  (:,  2)  =  theta_GPOPS_Pl ; 
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guess . phase (iphase) . State (:, 3)  =  Vr_GP0PS_Pl; 
guess . phase (iphase) . state (:,  4)  =  Vt_GP0PS_Pl; 

%  Control  guess  ; 

guess . phase (iphase) . control  (:,  1)  =  T_GP0PS_P1 ; 
guess . phase (iphase) . control  (:,  2)  =  Beta_GPOPS_Pl ; 
guess . phase (iphase) . integral  =  solution . phase ( 1) . integral ; 
% 


%  Phase  2  Information  (second  Maneuver 
iphase  =  2; 

bounds . phase (iphase) . initialtime . lower  =  tfl/TU; 
bounds . phase (iphase) . initialtime . upper  =  tfl/TU; 
bounds . phase (iphase) . finaltime . lower  =  tf2_min-l; 
bounds . phase (iphase) . finaltime . upper  =  tf2_max+l; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rmin  thetaf_min  -0.1 
8]  : 

bounds . phase (iphase) . initialstate . upper  =  [rmax  thetaf_max  0.1 
1.1]  : 

bounds . phase (iphase) . finalstate . lower  =  [rmin  thetaf2_min - 1  -0.1 

8]  ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  thetaf2_max+l  0.1 
1.1]  : 

bounds . phase (iphase) . state . lower  =  [rmin  thetaf_min  -0.1  0]; 
bounds . phase (iphase) . state . upper  =  [rmax  thetaf2_max+l  0.1  1.1]; 
bounds . phase (iphase) . control . lower  =  [Tmin  umin] ; 
bounds . phase (iphase) . control . upper  =  [Tmax  umax]  ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 
bounds . phase (iphase) . path . lower  =  [] ;  %  None 
bounds . phase (iphase) . path . upper  =  [] ;  %  None 
bounds . phase (iphase) . integral . lower  =  0; 
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bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =  [zeros(l,5)  800  Rmin/DU  Rmin 
/DU]  ;  %  None 

bounds . eventgroup (iphase) . upper  =  [zeros(l,5)  800  Rmax/DU  Rmax 
/DU]  ;  %  None 
%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  tvec_P2 ; 
guess . phase (iphase) . state (:, 1)  =  r_GP0PS_P2 ; 
guess . phase (iphase) . state (:,  2)  =  theta_GP0PS_P2 ; 
guess . phase (iphase) . state (:,  3)  =  Vr_GP0PS_P2  ; 
guess . phase (iphase) . state (:,  4)  =  Vt_GPOPS_P2 ; 

%  Control  guess  ; 

guess  .  phase (iphase) . control  (:,  1)  =  T_GP0PS_P2 ; 

guess . phase (iphase) . control  (:,  2)  =  Beta_GP0PS_P2  ; 

guess . phase (iphase) . integral  =  solution . phase (2) . integral ; 

% 


%  Phase  3  (Coast) 
iphase  =  3; 

bounds . phase (iphase) . initialtime . lower  =  tf2_min-l; 
bounds . phase (iphase) . initialtime . upper  =  tf2_max+l: 
bounds . phase (iphase) . finaltime . lower  =  tcoast3 (end) - 1 ; 
bounds . phase (iphase) . finaltime . upper  =  tcoast3 (end) +1 ; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
bounds . phase (iphase) . initialstate . lower  =  [rmin  thetaf 2_min - 1 
-0.1  0] : 

bounds . phase (iphase) . initialstate . upper  =  [rmax  thetaf2_max+l 

0.1  1.1]  : 

bounds . phase (iphase) . finalstate . lower  =  [rmin  theta3end-l  -0.1 
0]  ; 


336 


897 

898 

899 

900 

901 

902 

903 

904 

905 

906 

907 

908 

909 

910 

911 

912 

913 

914 

915 

916 

917 

918 

919 

920 

921 

922 

923 

924 

925 

926 


bounds . phase (iphase) . finalstate . upper  =  [rmax  theta3end+l  0.1 
1.1]  : 

bounds . phase (iphase) . state . lower  =  [rmin  thetaf2_min - 1  -0.1  0] ; 
bounds . phase (iphase) . state . upper  =  [rmax  theta3end+l  0.1  1.1]; 
bounds . phase (iphase) . control . lower  =  [00]; 
bounds . phase (iphase) . control . upper  =  [00]; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 
bounds . phase (iphase) . path . lower  =  [] ;  %  None 
bounds . phase (iphase) . path . upper  =  [] ;  %  None 
bounds . phase (iphase) . integral . lower  =  0; 
bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =  [zeros(l,5)  0];  %  None 
bounds . eventgroup (iphase) . upper  =  [zeros(l,5)  0];  %  None 
%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  tvec_P3 ; 
guess . phase (iphase) . state (:,  1)  =  r_GP0PS_P3 ; 
guess . phase (iphase) . state (:,  2)  =  theta_GP0PS_P3 ; 
guess . phase (iphase) . state  (:,  3)  =  Vr_GPOPS_P3 ; 
guess . phase (iphase) . state (:, 4)  =  Vt_GP0PS_P3 ; 

%  Control  guess  : 

guess  .  phase (iphase) . control  (:,  1)  =  T_GP0PS_P3 ; 

guess . phase (iphase) . control  (:,  2)  =  Beta_GP0PS_P3  ; 

guess . phase (iphase) . integral  =  solution . phase (3) . integral ; 

%  Phase  4  Information  (third  Maneuver) 
iphase  =  4; 

bounds . phase (iphase) . initialtime . lower  =  tcoast3 (end)  - 1 ; 
bounds . phase (iphase) . initialtime . upper  =  tcoast3 (end) +1 ; 
bounds . phase (iphase) . finaltime . lower  =  (tfl+tf2+tf4)/TU-l ; 
bounds . phase (iphase) . finaltime . upper  =  (tf l+tf2+tf4)/TU+l ; 

%  LIMITS  ON  STATE  AND  CONTROL  VALUES  THROUGHOUT  TRAJECTORY 
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bounds . phase (iphase) . initialstate . lower  =  [rmin  thetaSend-l  -®.l 

®] ; 

bounds . phase (iphase) . initialstate . upper  =  [rmax  theta3end+l  ®.l 
1.1]  : 

bounds . phase (iphase) . finalstate . lower  =  [rmin  theta_guess4 (end) 
-1  -8.1  ®] ; 

bounds . phase (iphase) . finalstate . upper  =  [rmax  theta_guess4 (end) 
+1  ®. 1  1.1]; 

bounds . phase (iphase) . state . lower  =  [rmin  theta3end-l  -®.l  Q] ; 
bounds . phase (iphase) . state . upper  =  [rmax  theta_guess4 (end) +1  ®.l 
1.1] : 

bounds . phase (iphase) . control . lower  =  [Tmin  umin] ; 
bounds . phase (iphase) . control . upper  =  [Tmax  umax] ; 

%  LIMITS  ON  PARAMETERS,  PATH,  AND  EVENT  CONSTRAINTS 

bounds . parameter . lower  =  [®  8  ®] ; 

bounds . parameter . upper  =  [2*pi  2*pi  2*pi] ; 

bounds . phase (iphase) . path . lower  =  [] ;  %  None 

bounds . phase (iphase) . path . upper  =  [] ;  %  None 

bounds . phase (iphase) . integral . lower  =  8; 

bounds . phase (iphase) . integral . upper  =  1; 

bounds . eventgroup (iphase) . lower  =[888  Rmin/DU  Rmin/DU] ;  % 

None 

bounds . eventgroup (iphase) . upper  =[888  Rmax/DU  Rmax/DU] ;  % 

None 

%  GUESS  SOLUTION 

guess . phase (iphase) . time  =  tvec_P4 ; 
guess . phase (iphase) . state (:,  1)  =  r_GP0PS_P4 ; 
guess . phase (iphase) . state  (:,  2)  =  theta_GP0PS_P4 ; 
guess . phase (iphase) . state (:,  3)  =  Vr_GP0PS_P4 ; 
guess . phase (iphase) . state (:,  4)  =  Vt_GP0PS_P4 ; 

%  Control  guess  ; 

guess . phase (iphase) . control  (:,  1)  =  T_GP0PS_P4 ; 
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guess . phase (iphase) . control ( : , 2)  =  Beta_GP0PS_P4 ; 

guess . parameter  =  [phi_GPOPS_Pl  phi_GP0PS_P2  phi_GP0PS_P3 ] 

guess . phase (iphase) .integral  =  solution . phase (4) .integral; 

%auxiliary  data 


auxdata 

MU  =  MU2  ; 

auxdata 

ae  =  ael; 

auxdata 

be  =  bel; 

auxdata 

rf_pqw  =  r£_pqw; 

auxdata 

vunit  =  vunit ; 

auxdata 

gunit  =  gunit ; 

auxdata 

inc  =  inc ; 

auxdata 

RAAN  =  RAAN; 

auxdata 

w  =  w ; 

auxdata 

latlim  =  latlim; 

auxdata 

longlim  =  longlim; 

auxdata 

GMST8  =  GMST8; 

auxdata 

OmegaEarth  =  OmegaEarth; 

auxdata 

DU  =  DU; 

auxdata 

TU  =  TU; 

%  NOTE: 

Functions  "phasingmaneuverCost "  and  "phasingmaneuverDae" 

required 

setup. name  =  ’ TIME_FIXED_INTERCEPT * 

colp  =  4; 


colnum  : 

=  28; 

colp2  = 

4; 

colnum2 

=  88; 

setup . functions . continuous  =  ©LT_3RTM_Continuous_4Phase 
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setup . functions . endpoint  =  ©LT_3RTM_Endpoint_4Phase ; 
setup . nip . solver  =  ’ ipopt *  ; 
setup . mesh . maxiteration  =  10; 
setup . mesh . tolerance  =  le-10; 
setup . mesh . colpointsmin  =  40; 
setup . mesh . colpointsmax  =  1000; 
for  i  =  1:4 
if  i  <  4 

setup . mesh . phase (i) .colpoints  =  colp*ones (1 , colnum) ; 
setup . mesh . phase (i) . fraction  =  1/ colnum* ones (1 , colnum) ; 
elseif  i  ==  3 

setup . mesh . phase (i). colpoints  =  l*ones (1,5) ; 
setup . mesh . phase (i) . fraction  =  1/5* ones (1,5) ; 

else 

setup . mesh . phase (i). colpoints  =  colp2  * ones (1 , colnum2) ; 
setup . mesh . phase (i) . fraction  =  l/colnum2  * ones (1 , colnum2) 


end 

end 

setup. bounds  =  bounds; 

setup. guess  =  guess; 

setup . auxdata  =  auxdata; 

setup . mesh . method  =  ’ RPMintegration * ; 

setup . derivatives . supplier  =  ’ sparseFD ’ ; 

setup . derivative level  = ’ second  ’  ; 

setup . dependencies  =  ’sparseNaN’; 

setup. scales  =  ’none’; 

output  =  gpops2 ( setup) ; 

solution 2  =  output . result . solution ; 


%% 
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%States  and  costates  from  phase  1  (first  maneuver) 
r_GP0PS_P12  =  solution2 . phase (l).state(:,l); 
theta_GP0PS_P12  =  solution2 . phase (l).state(:,2); 

Vr_GP0PS_P12  =  solution2 . phase (l).state(:,3); 

Vt_GPOPS_P12  =  solution2 . phase (1) . state(:  ,4) ; 
lambda_r_P12  =  solution2 . phase (l).costate(:,l); 
lambda_theta_P12  =  solution2 . phase (1) .cost at e(:  ,2)  ; 
lambda_Vr_P12  =  solution2 . phase (1) .cost at e(: ,3) ; 
lambda_Vt_P12  =  solution2 . phase (1) .cost at eC:  ,4) ; 
tvec_P12  =  solution 2 . phase (1) . time ; 

thetadot_GP0PS_P12  =  Vt_GP0PS_P12 . /r_GP0PS_P12 ; 

T_GP0PS_P12  =  solution2 . phase (1) . control ( : , 1) ; 

Beta_GP0PS_P12  =  solution2 . phase (1) . control ( :  ,  2) ; 
phi_GP0PS_P12  =  solution2 . parameter (1) ; 

re_GPOPS_P12  =  ael*bel/sqrt ( (bel*cos (phi_GP0PS_P12) ) "2  +  (ael * 
sinCphi_GP0PS_P12)) "2) ; 

%States  and  Costates  from  pahse  2  (second  maneuver) 
r_GPOPS_P22  =  solution2 . phase (2).state(:,l); 
theta_GPOPS_P22  =  solution2 . phase (2).state(:,2); 

Vr_GPOPS_P22  =  solution2 . phase  (2).state(:,3); 

Vt_GPOPS_P22  =  solution2 . phase (2) . state(: ,4) ; 
lambda_r_P22  =  solution2 . phase (2).costate(:,l); 
lambda_theta_P22  =  solution2 . phase (2) .cost at e(: ,2) ; 
lambda_Vr_P2  2  =  solution2 . phase (2) .cost at e(:  ,3) ; 
lambda_Vt_P22  =  solution2 . phase (2) .cost at e(: ,4) ; 
tvec_P22  =  solution 2 . phase (2) . time ; 

thetadot_GPOPS_P22  =  Vt_GPOPS_P22 . /r_GPOPS_P22 ; 

T_GPOPS_P22  =  solution2 . phase (2) . control ( :  ,  1) ; 

Beta_GPOPS_P22  =  solution2 . phase (2) . control ( : , 2) ; 
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phi_GPOPS_P22  =  solution2 . parameter (2) ; 

re_GPOPS_P22  =  ael*bel/sqrt ( (be  1  *  cos (phi_GPOPS_P2 2 ) ) "2  +  (ael * 
sinCphi_GPOPS_P22)) "2) ; 

%States  and  Costates  from  pahse  2  (second  maneuver) 
r_GPOPS_P32  =  solution2 . phase (3).state(:,l); 
theta_GPOPS_P32  =  solution2 . phase (3).state(:,2); 

Vr_GPOPS_P32  =  solution2 . phase (3).state(:,3); 

Vt_GPOPS_P32  =  solution2 . phase (3) . state(:  ,4) ; 
lambda_r_P32  =  solution2 . phase (3).costate(:,l); 
lambda_theta_P32  =  solution2 . phase (3) .cost at e(: ,2) ; 
lambda_Vr_P32  =  solution2 . phase  (3) .cost at e(:  ,3) ; 
lambda_Vt_P32  =  solution2 . phase (3) .cost at e(: ,4) ; 
tvec_P32  =  solution 2 . phase (3) . time ; 

thetadot_GPOPS_P32  =  Vt_GPOPS_P32 . /r_GPOPS_P32 ; 

T_GPOPS_P32  =  solution2 . phase (3) . control  (  :  ,  1) ; 

Beta_GPOPS_P32  =  solution2 . phase (3) . control ( :  , 2)  ; 
phi_GPOPS_P32  =  solution2 . parameter (3) ; 

re_GPOPS_P32  =  ael*bel/sqrt ( (be  1  *  cos (phi_GPOPS_P32 ) ) "2  +  (ael * 
sin(phi_GPOPS_P32)) "2) ; 

%States  and  Costates  from  pahse  2  (second  maneuver) 
r_GP0PS_P42  =  solution2 . phase (4).state(:,l); 
theta_GP0PS_P42  =  solution2 . phase (4).state(:,2); 

Vr_GPOPS_P42  =  solution2 . phase (4).state(:,3); 

Vt_GPOPS_P42  =  solution2 . phase (4) . state(:  ,4) ; 
lambda_r_P42  =  solution2 . phase (4).costate(:,l); 
lambda_theta_P42  =  solution2 . phase (4) .cost at e(: ,2) ; 
lambda_Vr_P42  =  solution2 . phase  (4) .cost at e(:  ,3) ; 
lambda_Vt_P42  =  solution2 . phase (4) .cost at e(: ,4) ; 
tvec_P42  =  solution 2 . phase (4) . time ; 
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thetadot_GPOPS_P42  =  Vt_GP0PS_P42 . /r_GPOPS_P42 ; 

T_GP0PS_P42  =  solution2 . phase (4) . control ( : , 1) ; 

Beta_GP0PS_P42  =  solution2 . phase (4) . control ( : , 2) ; 
re_GPOPS_P42  =  ael -'bel/sqrt  (  (be  1  *cos  (phi_GPOPS_P32  )  )  ''2  +  (ael* 
sinCphi_GPOPS_P32)) "2) ; 

Cost2  =  (solution2 . phase (1) . integral  +  solution2 . phase (2) . 

integral  +  solution2 . phase (3) . integral  +  solution2 . phase (4) . 
integral)  *DU/TU''  1000 


%% 

clear  rgi  rgi2 

ang  =  (0  :  0 . 001 :  2 ''pi)  ; 

re  =  (ael*bel)  ./sqrt  CCbel''cos(ang))  . ''2  +  (ael*sin(ang))  . ''2)  ; 


% 


%  Determine  entry  condition  for  second  maneuver 

rt  =  [r_GP0PS_P12 (end) *cos (theta_GP0PS_P12 (end) ) ; r_GP0PS_P12 (end 
)*sin(theta_GP0PS_P12 (end)) ;0] ; 

%apogee  and  perigee  constraints 

V£_mag  =  sqrt (Vr_GPOPS_P12 (end) ”2  +  Vt_GP0PS_P12 (end) "2) ; 
fpa  =  atan(Vr_GPOPS_P12 (end)/Vt_GP0PS_P12 (end)) ; 

%peri focal  velocity 

vt  =  Vf_mag * [- sin( theta_GP0PS_P12 (end) -fpa) ; cos ( theta_GPOPS_P12 ( 
end)-fpa) ;0] ; 
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[rt_i  jk_P12  ,  vt_i  jk_P12  ]  =  PQW_to_I  JK  (rt ,  vt ,  inc  ,  RAAN  ,  w)  ; 
rt_ijk_P12  =  rt_ijk_P12*DU; 
vt_ijk_P12  =  vt_ijk_P12*DU/TU; 


[lat_act_enter , long_act_enter ]  =  IJK_to_LATLONGCrt_i jk_P12 (1) , 
rt_i  jk_P12  (2)  ,  rt_i  jk_P12  (3)  ,  GMST®  ,  tvec_P12  (end)  *111)  ; 

[r2  ,  v2  ,  t2  ]  =  zone_entry_exit2  (rt_i  jk_P12  ,  vt_i  jk_P12  ,GMST0  + 
OmegaEarth*tvec_P12 (end) *TU , 0 , latlim , longlim)  ; 

r£2exp  =  r2 ; 
v£2exp  =  v2 ; 
t£2exp  =  t2 ; 

[lat_enter2exp , long_enter2exp]  =  I JK_to_LATLONG (r2 (1) ,r2(2) ,r2 
(3) ,GMST0 , tvec_P22 (end)*TU) ; 

[r£_pqw2 , v£_pqw2 ]  =  I JK_to_PQW (r2 , v2 , inc , RAAN , w) ; 

r£_pqw2  =  r£_pqw2/DU; 
v£_pqw2  =  v£_pqw2/DU*TU ; 

vunit2  =  v£_pqw2/norm(v£_pqw2) ; 
h£p2  =  cross (r£_pqw2 , v£_pqw2) ; 
hunit2  =  h£p2/norm(h£p2) ; 

gunit2  =  cross (vunit2 , hunit2) ; 


% 
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%  for  plotting  purposes  in  PQW  frame 
% 


terml2  =  (be  1  *  cos (phi_GPOPS_P22 ) ) " 2  +  (ael*sinCphi_GPOPS_P22)) 
"2; 

re2  =  ael*bel/sqrt(terml2) ; 

rt2  =  rf_pqw2  +  re2  *cos  Cphi_GP0PS_P2  2  )  *  vunit2  +  re2''sinC 
phi_GPOPS_P22)*gunit2 ; 

%apogee  and  perigee  constraints 

Vf_mag2  =  sqrt  CVr_GP0PS_P2 2  (end) '' 2  +  Vt_GPOPS_P22  (end)  "2)  ; 
fpa2  =  atan(Vr_GPOPS_P22 (end)/Vt_GPOPS_P22 (end)) ; 

%peri focal  velocity 

vt2  =  Vf_mag2  * [ - sin( theta_GPOPS_P2  2 (end) -fpa2) ;cos( 
theta_GPOPS_P22 (end) -fpa2) ;0] ; 

[rt_i jk_P22 , vt_i jk_P22 ]  =  PQW_to_IJK (rt2 , vt2 , inc , RAAN , w) ; 
rt_ijk_P22  =  rt_i jk_P22 *DU ; 
vt_ijk_P22  =  vt_i jk_P22*DU/TU; 
rt2  =  rt2*DU; 

[lat_act_enter2 , long_act_enter2 ]  =  IJK_to_LATLONG(rt_i jk_P22 (1) , 
rt_i  jk_P22  (2)  ,  rt_i  jk_P22  (3)  ,  GMST®  ,  tvec_P2  2  (end)  *111)  ; 

for  aa  =  1 : length (ang) 

r_ell2(:,aa)  =  rf_pqw2  +  re  (aa)  *cos  (ang  (aa)  ) ''vunit2  +  re(aa) 
''sin(ang  (aa)  )  *gunit2  ; 

end 
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[r4,v4,t4]  =  zone_entry_exit2  (rt_i  jk_P22  ,vt_ijk_P22  ,GMSTQ  + 


OmegaEarth*tvec_P22 (end) *TU , 0 , latlim , longlim) ; 

r£4exp  =  r4 ; 
v£4exp  =  v4 ; 
t£4exp  =  t4 ; 

[lat_enter4exp , long_enter4exp]  =  I JK_to_LATL0NG  Cr4 (1) , r4 (2) , r4 
(3) ,GMST0 , tvec_P42 (end)*TU) ; 

[r£_pqw4 , v£_pqw4]  =  I JK_to_PQW (r4 , v4 , inc , RAAN , w) ; 

r£_pqw4  =  r£_pqw4/DU; 
v£_pqw4  =  v£_pqw4/DU*TU ; 

vunit4  =  v£_pqw4/norm(v£_pqw4) ; 
h£p4  =  cross Cr£_pqw4 , v£_pqw4) ; 
hunit4  =  h£p2/norm(h£p4) ; 

gunit4  =  cross (vunit4 , hunit4) ; 

£or  aa  =  1 : length (ang) 

r_ell4C:,aa)  =  r£_pqw4  +  re  (aa)  *cos  (ang  (aa)  ) ''vunit4  +  re(aa) 
''sin(ang  (aa)  )  *gunit4  ; 

end 

rt4  =  [r_GP0PS_P42 (end)*cos(theta_GPOPS_P42 (end)) ; r_GP0PS_P42 ( 
end)  ''sin(  theta_GP0PS_P42  (end)  )  ;  0]  ; 

%apogee  and  perigee  constraints 

V£_mag4  =  sqrt  (Vr_GP0PS_P42  (end) '' 2  +  Vt_GP0PS_P42  (end)  "2)  ; 
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fpa4  =  atan(Vr_GPOPS_P42 Cend)/Vt_GP0PS_P42 (end)) ; 


%peri focal  velocity 

vt4  =  V£_mag4* [ - sin( theta_GPOPS_P42 (end) -£pa4) ; cos ( 
theta_GP0PS_P42 (end) - £pa4) ;®] ; 

[rt_i jk_P42 , vt_i jk_P42 ]  =  PQW_to_I JK (rt4 , vt4 , inc , RAAN , w) ; 
rt_ijk_P42  =  rt_i jk_P42 *DU ; 
vt_ijk_P42  =  vt_ijk_P42*DU/TU; 
rt4  =  rt4*DU; 

[lat_act_enter4 , long_act_enter4]  =  IJK_to_LATLONG(rt_i jk_P42 (1) , 
rt_i  jk_P42  (2)  ,  rt_i  jk_P42  (3)  ,  GMST®  ,  tvec_P42  (end)  *111)  ; 

rgi  =  zeros (length(r_GP0PS_P12)  ,3)  ; 
vgi  =  zeros (length(r_GP0PS_P12)  ,3) ; 

%First  maneuver  inertial  position  and  velocity 
for  dd  =  1 : length (r_GP0PS_P12 ) 

%peri£ocal  position  vector 

rg_pqw  =  DU* [r_GP0PS_P12 (dd) *cos (theta_GPOPS_P12 (dd) ) ; 

r_GPOPS_P12 (dd)*sin(theta_GP0PS_P12 (dd)) ;0] ; 

%velocity  magnitude 

V£_mag  =  sqrt  (Vr_GP0PS_P12  (dd) ''2  +  Vt_GP0PS_P12  (dd)  ”2)  ; 
fpa  =  atan(Vr_GP0PS_P12 (dd)/Vt_GP0PS_P12 (dd)) ; 

%peri focal  velocity 

vg_pqw  =  DU/TU*Vf_mag  * [ -  sin ( theta_GP0PS_P 12 (dd) -fpa) ; cos ( 
theta_GP0PS_P12 (dd) -fpa) ;0] ; 

[rgi  (dd  ,  :  )  ,  vgi  (dd  ,  :  )  ]  =  PQW_to_I3K  (rg_pqw  ,  vg_pqw  ,  inc  ,  RAAN  ,  w) 


end 
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rgi2  =  zeros (length (r_GP0PS_P2 2 )  ,  3) ; 
vgi2  =  zeros (length (r_GP0PS_P2 2 )  ,  3) ; 

%First  maneuver  inertial  position  and  velocity 
for  dd  =  1 : length(r_GPOPS_P22) 

%peri£ocal  position  vector 

rg_pqw2  =  DU* [r_GPOPS_P22 (dd) *cos ( theta_GPOPS_P22 (dd) ) ; 

r_GPOPS_P22 (dd)*sin(theta_GPOPS_P22 (dd)) ;0] ; 

%velocity  magnitude 

V£_mag  =  sqrt  (Vr_GPOPS_P22  (dd) ''2  +  Vt_GPOPS_P22  (dd)  ”2)  ; 

£pa  =  atan(Vr_GPOPS_P22 (dd)/Vt_GPOPS_P22 (dd)) ; 

%peri focal  velocity 

vg_pqw2  =  DU/TU*V£_mag* [- sin (theta_GPOPS_P22 (dd) -fpa) ; cos ( 
theta_GPOPS_P22 (dd) -fpa) ;0] ; 

[rgi2(dd,:),vgi2(dd,:)]  =  PQW_to_I 3K (rg_pqw2 , vg_pqw2 , inc , 
RAAN ,w) ; 

end 

rgi 3  =  zeros (length (r_GP0PS_P 32 )  ,  3) ; 
vgi 3  =  zeros (length (r_GP0PS_P 32 )  ,  3) ; 

%First  maneuver  inertial  position  and  velocity 
for  dd  =  1 : length(r_GPOPS_P32) 

%peri£ocal  position  vector 

rg_pqw3  =  DU* [r_GPOPS_P32 (dd) *cos (theta_GPOPS_P32 (dd) ) ; 

r_GPOPS_P32(dd)*sin(theta_GPOPS_P32(dd)) ;0] ; 

%velocity  magnitude 

V£_mag  =  sqrt  (Vr_GPOPS_P32  (dd)  ”2  +  Vt_GPOPS_P32  (dd) ''2)  ; 
fpa  =  atan(Vr_GPOPS_P32 (dd)/Vt_GPOPS_P32 (dd)) ; 

%peri focal  velocity 
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vg_pqw3  =  DU/TU* V£_mag * [ - sin ( theta_GPOPS_P32 (dd) - fpa) ; cos ( 
theta_GPOPS_P32 (dd) -fpa) ;0] ; 

[rgi3 (dd , : ) , vgi3 (dd , : ) ]  =  PQW_to_I3K(rg_pqw3 , vg_pqw3 , inc , 
RAAN ,w) ; 

end 

rgi4  =  zeros (length (r_GP0PS_P42 ),  3)  ; 

vgi4  =  zeros (length (r_GP0PS_P42 ),  3) ; 

%First  maneuver  inertial  position  and  velocity 

for  dd  =  1 : length (r_GP0PS_P42 ) 

%peri£ocal  position  vector 

rg_pqw4  =  DU* [ r_GP0PS_P42 (dd) *  cos ( theta_GPOPS_P42 (dd) ) ; 
r_GP0PS_P42  (dd)*sin(theta_GP0PS_P42  (dd))  ;(3]  ; 

%velocity  magnitude 

V£_mag  =  sqrt (Vr_GP0PS_P42 (dd) "2  +  Vt_GP0PS_P42 (dd) "2) ; 

fpa  =  atan(Vr_GP0PS_P42 (dd)/Vt_GPOPS_P42 (dd)) : 

%peri£ocal  velocity 

vg_pqw4  =  DU/TU* V£_mag *[- sin ( theta_GP0PS_P42 (dd) - fpa) ; cos ( 
theta_GP0PS_P42 (dd) -fpa) ;0] ; 

[rgi4 (dd , : ) , vgi4 (dd  ,  : ) ]  =  PQW_to_I3K(rg_pqw4 , vg_pqw4 , inc  , 
RAAN ,w) ; 

end 

%% 


%save  optimal  path  in  structure 

optans2.ics  =  struct(’rQ’, rQvec , ’ vQ ’ , vQvec , ’ tO ’ , t® , ’ ae ’ , ae , ’ be ’ , 
be , ’ Rmax ’ , Rmax , ’ Rmin ’ , Rmin , ’ latlim ’ , latlim , ’ longlim ’ , longlim 
, ’GUSTO ’ ,GMST® , . . . 
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’ inc ’ , inc , ’ RAAN ’ , RAAN , ’ w ’ , w , ’ ang ’ , ang ) ; 
optans2 . scale  =  struct (  ’  TU ’  , TU  ,  ’  DU  ’  ,  DU ,  ’ MU ’ , MU2) ; 
optans2 . entry (1)  =  struct (’ lat_enter lat_enter long_enter ’ , 
long_enter , ’ r_ell ’ , r_ell , ’ rti jk ’ , rgi (end , : ) , ’ vti jk ’ , vgi (end 
, : ) , ’ rt_pqw ’ , rg_pqw , ’ rf_pqw ’ , rf_pqw , . . . 

’ lat_act_enter ’ , lat_act_enter , ’ long_act_enter ’ , 
long_act_enter , ’r£l’ ,rfl, ’v£l' ,v£l, ’t£l’ ,t£l); 
optans2 . entry (2)  =  struct (’ lat_enter lat_enter2exp long_enter 
, long_enter2exp , ’ r_ell ’ ,r_ell2 , ’rtijk’ ,rgi2 (end , : ) , ’ vti jk ’ , 
vgi2 (end , : ) , ’ rt_pqw ’ , rt2 , ’ r£_pqw ’ , r£_pqw2 , . . . 

’ lat_act_enter ’ , lat_act_enter2 , ’ long_act_enter  ’  , 

long_act_enter2 , ’r£l’ ,r£2exp, ’v£l’ ,v£2exp, ’t£l’ ,t£2exp); 
optans2 . entry (4)  =  struct (’ lat_enter lat_enter4exp long_enter 
, long_enter4exp , ’ r_ell ’ , r_ell4 , ’ rtijk ’ , rgi4 (end , : ) , ’ vti jk ’ , 
vgi4 (end , : ) , ’ rt_pqw ’ , rt4 , ’ r£_pqw ’ , r£_pqw4 , . . . 

’ lat_act_enter ’ , lat_act_enter4 , ’ long_act_enter ’ , 

long_act_enter4 , ’r£l’ ,r£4exp, ’v£l’ ,v£4exp, ’t£l’ ,t£4exp): 
optans2 . phase (1)  =  struct (’ state solution2 . phase (1) . state  ,  ’ 
costate’ ,solution2. phase (1) .costate , ’ control ’ , solution2 . 
phase (1) . control , ’ time ’ , tvec_P12 , ’rgi ’ ,rgi) ; 
optans2 . phase (2)  =  struct (’ state solution2 . phase (2) . state , ’ 
costate’ ,solution2. phase (2) .costate , ’ control ’ , solution2 . 
phase (2) . control , ’ time ’ , tvec_P22 , ’rgi ’ ,rgi2) ; 
optans2 . phase (3)  =  struct (’ state ’, solution2 . phase (3) . state ,  ’ 
costate’ ,solution2. phase (3) .costate , ’ control ’ , solution2 . 
phase (3) . control , ’ time ’ , tvec_P32 , ’rgi ’ ,rgi3) ; 
optans2 . phase (4)  =  struct (’ state ’, solution2 . phase (4) . state , ’ 
costate’ ,solution2. phase (4) .costate , ’ control ’ , solution2 . 
phase (4) . control , ’ time ’ , tvec_P42 , ’rgi ’ ,rgi4) ; 
optans2 . parameter  =  solution2 . parameter ; 

rOstring  =  num2str (norm(rOvec) ) ; 
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aestr  =  num2str (ae) ; 
itstr  =  num2str (PS0_data (cc , end) ) ; 
tempstr  =  [aestr  itstr]  ; 
aestring  =  num2str (tempstr)  ; 

dir  =  ’C:\Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Triple  Pass\Images\ ’ ; 

dir2  =  ’C:\Users\Dan  Showalter\Documents\MATLAB\Low  Thrust  RTM\ 
Triple  Pass\Data\’; 

tend  =  toc(tstart); 

exflag  =  output . result . nlpinfo ; 

£id2  =  fopenC ’ C : \Users\Dan  Showalter\Documents\MATLAB\Low  Thrust 
RTM\Triple  Pass\Data\PS02GP0PSTriplePassDatal2Q. txt ’ , ’ a ’ ) ; 

fprintf (£id2 , ’%i\t  %i\t  %4.3£\t  %4.3£\t  %4.3£\t  %6.5£\t  %6.5£\t 
%6.5£\t  %6.2£\t  %i\r\n’,... 

norm(rO) , ae , phi_GP0PS_P12 , phi_GPOPS_P22 , phi_GPOPS_P32 , 
PSO_data(cc , 18) .Cost ,Cost2 , tend , ex flag) ; 

£id3  =  fopenC ’ C : \Users\Dan  Showalter\Documents\MATLAB\Low  Thrust 
RTM\Triple  Pass\Data\TriplePassCostl20.txt’ , ’a’) ; 
£print£(£id3 , ’%i\t  %i  \t  %4.3£\t  %4.3£\t  %4.3£\t  %4.3£\t  %i\t\r 
\n’  ,  .  . . 

norm(rO) , ae , solution2 . phase (1) . integral*DU/TU*100® , solution2 
. phase (2) . integral*DU/TU*100® , solution2 . phase (4) . 
integral*DU/TU*l®®® , Cost2 , exflag) ; 

if  exflag  ==  ® 

%plot  optimal  results 
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[op tout]  =  LT_TRIPLE_PASS_PLOTS (op tans 2 , r® string , ae string , 


dir)  ; 

dataname  =  [ ’ TriplePass ’  rOstring  aestring]; 

%save  data 

save (s treat (dir 2 , [dataname] ) , *  output ’ ) ; 

end 

clear  optans 
close  all 


end 

end 

E.3,2,2  Triple  Pass  LTRTM  Equations  of  Motion  and  Cost  Function 

function  phaseout  =  LT_3RTM_Continuous_4Phase (input) 

%%  Phase  1 

si  =  input . phase (1) . state ; 
ul  =  input . phase (1) . control ; 

%  Equations  of  Motion 
% 


rl  =  sl(: , 1) ; 
vrl  =  sl(: , 3) ; 
vthetal  =  si ( : , 4) ; 

T1  =  ul(: ,1); 
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B1  =  ulC: ,2) : 


MU2  =  input . auxdata . MU : 

r_dotl  =  vrl; 
theta_dotl  =  vthetal./rl; 

vr_dotl  =  (vthetal  .  ■'2)  ./fl  -  MU2  . /(fl  . '"2)  +  Tl.*sin(Bl); 
vtheta_dotl  =  -vthetal . *vr 1 . /rl  +  Tl.*cosCBl); 

%  Form  matrix  output 

daeoutl  =  [r_dotl  theta_dotl  vr_dotl  vtheta_dotl] ; 

phaseout (1) . dynamics  =  daeoutl; 

% 


%  Cost  Function 

phaseout (1) . integrand  =  Tl; 

%%  Phase  2 

s2  =  input . phase (2) . state ; 
u2  =  input . phase (2) . control ; 

%  Equations  of  Motion 
% 


r2  =  s2  (  :  ,  1)  : 
vr2  =  s2  C  :  ,  3)  : 
vtheta2  =  s2 ( :  ,  4) ; 
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T2  =  u2(:  ,1)  : 
B2  =  u2(: ,2) : 


r_dot2  =  vr2  ; 
theta_dot2  =  vtheta2./r2; 

vr_dot2  =  (vtheta2  .  "2)  ./r'2  -  MU2  ./(r2  .  "2)  +  T2.*sin(B2); 
vtheta_dot2  =  -vtheta2 . * vr2 . /r2  +  T2.*cosCB2); 

%  Form  matrix  output 

daeout2  =  [r_dot2  theta_dot2  vr_dot2  vtheta_dot2 ] ; 

phaseout (2) . dynamics  =  daeout2 ; 

% 


%  Cost  Function 

phaseout (2) . integrand  =  T2 ; 

%%  Phase  3 

s3  =  input . phase (3) . state : 
u3  =  input . phase (3) . control : 

%  Equations  of  Motion 
% 


r3  =  s3(:  ,1)  ; 
vr3  =  s3C:  ,  3)  : 
vtheta3  =  s3 ( :  ,  4) ; 

T3  =  u3(:  ,1)  : 
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B3  =  u3(: ,2) : 


r_dot3  =  vr3  : 
theta_dot3  =  vtheta3./r3; 

vr_dot3  =  (vtheta3  .  "2)  ./r'3  -  MU2  ./(r3  .  "'2)  +  T3.*sin(B3); 
vtheta_dot3  =  -vtheta3 . * vr3  . /r3  +  +  T3.*cosCB3); 

%  Form  matrix  output 

daeout3  =  [r_dot3  theta_dot3  vr_dot3  vtheta_dot3] ; 

phaseout (3) . dynamics  =  daeout3; 

% 


%  Cost  Function 

phaseout (3) . integrand  =  zeros Clength(r3)  ,  1) ; 

%%  Phase  4 

s4  =  input . phase (4) . state ; 
u4  =  input . phase (4) . control ; 

%  Equations  of  Motion 
% 


r4  =  s4(:  ,  1)  : 
vr4  =  s4 ( :  ,  3)  : 
vtheta4  =  s4  (  :  ,  4)  ; 

T4  =  u4(:  ,  1)  : 

B4  =  u4(:  ,2)  : 
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r_dot4  =  vr4 ; 
theta_dot4  =  vtheta4./r4; 

vr_dot4  =  (vtheta4  .  "2)  ./r4  -  MU2  .  /  (r4  . 2)  +  T4.*sin(B4); 
vtheta_dot4  =  -vtheta4 . * vr4 . /r4  +  T4.*cosCB4); 

%  Form  matrix  output 

daeout4  =  [r_dot4  theta_dot4  vr_dot4  vtheta_dot4] ; 

phaseout (4) . dynamics  =  daeout4 ; 

% 


%  Cost  Function 

phaseout (4) . integrand  =  T4; 

E,3,2,3  Triple  Pass  LTRTM  Constraints 

function  output  =  LT_3RTM_Endpoint_4Phase (input) 


%%  Cost  Function  Evaluation 
% 


J  =  input . phase (1) . integral  +  input . phase (2) . integral  +  input . phase (3) . 

integral  +  input . phase (4) .integral; 
output . obj ective  =  J; 

% 


%%  Event  Constraints 
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%%  Phase  1  (First  Maneuver) 


%phase 

2  vai 

'iables 

tfl  = 

input . 

phase  (1) 

. finaltime ; 

xfl  = 

input . 

phase (1) 

. finalstate ; 

p  =  input . parameter ; 

phi  = 

p(i) ; 

%phase 

2  vai 

'iables 

t02  = 

input . 

phase  (2) 

. initialtime ; 

tf2  = 

input . 

phase (2) 

. finaltime ; 

x02  = 

input . 

phase  (2) 

. initialstate 

xf2  = 

input . 

phase (2) 

. finalstate ; 

phi2  = 

pC2)  ; 

%phase 

3  vai 

'iables 

t03  = 

input . 

phase  (3) 

. initialtime ; 

tf3  = 

input . 

phase (3) 

. finaltime ; 

x03  = 

input . 

phase  (3) 

. initialstate 

xf3  = 

input . 

phase (3) 

. finalstate ; 

%phase 

3  vai 

'iables 

t04  = 

input . 

phase  (4) 

. initialtime ; 

tf4  = 

input . 

phase (4) 

. finaltime ; 

x04  = 

input . 

phase (4) 

. initialstate 

xf4  = 

input . 

phase (4) 

. finalstate ; 

phi3  = 

pC3)  ; 

r£  =  X 

flCD  ; 

thetaf 

=  xfl 

(2)  ; 

Vrf  = 

x£l(3) 

» 

Vtf  = 

x£l(4) 

» 
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ael  =  input .  auxdata .  ae ;  %semiinajor  axis  of  exclusion  ellipse 
bel  =  input.auxdata.be;  %  semiminor  axis  of  exclusion  ellipse 
MU2  =  input . auxdata . MU ;  %gravitational  parameter  scaled  by  DU  and  TU 
rf_pqw  =  input . auxdata . rf_pqw ;  %  perifocal  position  vector  of  initial 
corssing  into  exclusion  zone 

vunit  =  input . auxdata . vunit ;  %perifocal  unit  velocity  vector  of  initial 
crossing  into  exclusion  zone 

gunit  =  input . auxdata . gunit ;  %perifocal  unit  vetcor  of  initial  crossing 
into  exclusion  zone 

terml  =  (bel ''cos (phi) )  ”2  +  (ael*sin(phi))  "2  ; 

re  =  ael*bel/sqrt (terml) ; 

rt  =  rf_pqw  +  re -'cos  (phi ) -'vunit  +  re''sin(phi) -'gunit ; 

%final  position  constraints 
eventl  =  rf *cos ( thetaf )  -  rt(l); 
event2  =  rf *sin(thetaf )  -  rt(2); 

%velocity  magnitude  and  flight  path  angle 
Vf_mag  =  sqrt(Vrf''2  +  Vtf''2); 
fpa  =  atan(Vrf/Vtf) ; 

%peri focal  velocity 

vt  =  Vf_mag*[-sin(thetaf-fpa) ; cos (thetaf -fpa) ;0] ; 

[a, ecc =  RV2C0E_MU(rt ,vt,MU2) ; 

Ra  =  a*(l+ecc); 

Rp  =  a*(l-ecc) ; 
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events  =  Ra ; 
event4  =  Rp ; 


%  Linkage  Constraints 

event l_link_state  =  x02  -  x£l; 

event l_link_time  =  tQ2  -  tfl; 

output . event group (1) . event  =  [event l_link_st ate  event l_link_ time  event  1 
event2  events  event4] ; 

%%  Phase  2  (Second  Maneuver) 

%  constant  variables 

inc  =  input . auxdata . inc ;  %inclination  of  initial  orbit  (used  to  convert 
everything  into  perifocal  frame  of  initial  orbit) 

RAAN  =  input . auxdata . RAAN ;  %RAAN  of  initial  orbit  (used  to  convert 
everything  into  perifocal  frame  of  initial  orbit) 
w  =  input . auxdata . w ;  %argument  of  perigee  of  initial  orbit  (used  to 
convert  everything  into  perifocal  frame  of  initial  orbit) 
latlim  =  input . auxdata . latlim ; 
longlim  =  input . auxdata . longlim ; 

GMSTO  =  input . auxdata . GMSTO ; 

OmegaEarth  =  input . auxdata . OmegaEarth ; 

DU  =  input . auxdata . DU ; 

TU  =  input . auxdata . TU ; 


rf2  =  xf 2 (1) ; 
thetaf 2  =  xf2 (2) ; 
Vr£2  =  x£2(S)  ; 
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Vt£2  =  x£2(4)  ; 


%position  and  velocity  o£  initial  intercept  in  peri£ocal  £rame  o£ 
initial 
%orbit 

i£  isnan(r£)  ==  1  | |  isnan ( theta£)  ==  1  | |  isnan(V£_mag)  ==  1  | |  isnan( 
t£l)  ==  1  I  I  isnan(phi)  ==  1  ... 

I  I  isnan(r£2)  ==  1  |  |  isnan(theta£2)  ==  1  |  |  isnanCt£2)  ==  1  |  | 


isnanCphi2)  = 

event2 1 

=  NaN 

event22 

=  NaN 

event2  5 

=  NaN 

event2  3 

=  NaN 

event24 

=  NaN 

Vf_mag2 

=  NaN 

else 

[rt_i jk , vt_i jk]  =  PQW_to_I JK (rt , vt , inc  ,  RAAN  ,  w)  ; 
rt_ijk  =  rt_ijk*DU; 
vt_ijk  =  vt_ijk*DU/TU; 

[r2,v2,t2, t2_exit]  =  zone_entry_exit2 (rt_i jk , vt_i jk , GMST0+ 
OmegaEarth*t£l ''TU  ,  ®  ,  latlim  ,  longlim)  ; 

[r£_pqw2 , v£_pqw2 ]  =  IJK_to_PQW (r2 , v2 , inc , RAAN , w) ; 

r£_pqw2  =  r£_pqw2/DU; 
v£_pqw2  =  v£_pqw2/DU*TU ; 

vunit2  =  v£_pqw2/norinCv£_pqw2)  ; 
h£p2  =  cross (r£_pqw2 , v£_pqw2) ; 
hunit2  =  h£p2/norm(h£p2) ; 
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gunit2  =  cross (vunit2 , hunit2) ; 

terml2  =  (be  1 ''cos  (phi2  )  ) '' 2  +  (ae  1  *  sin  (phi2  )  )  ”  2  ; 
re2  =  ael*bel/sqrt (terml2) ; 

rt2  =  r£_pqw2  +  re2 *cos (phi2 ) * vuni t2  +  re2 *  sin (phi2 ) * guni t2 ; 

%final  position  constraints 
event21  =  rf2 *cos ( thetaf 2 )  -  rt2(l); 
event22  =  rf2*sin(thetaf2)  -  rt2C2); 

%apogee  and  perigee  constraints 
V£_mag2  =  sqrt(Vr£2''2  +  Vt£2''2); 

£pa2  =  atanCVr£2/Vt£2) ; 

%peri£ocal  velocity 

vt2  =  V£_mag2  * [- sin (theta £2  - £pa2 ) ; cos (theta£2 - £pa2) ; 0] ; 

[a2 , ecc2 =  RV2C0E_MU (rt2 , vt2 , MU2 ) ; 

Ra2  =  a2*(l+ecc2) ; 

Rp2  =  a2 ''(l-ecc2)  ; 

event2  3  =  Ra2 ; 
event24  =  Rp2 ; 

event25  =  t£2  -  (t£l  +  t2/TU) ; 
end 

%  Linkage  Constraints 
event2_link_state  =  xQ3  -  x£2 ; 
event2_link_time  =  t®3  -  t£2 ; 
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output . event group (2) . event  =  [ event 2_link_st ate  event 2 _link_ time  event 2 1 
event22  event25  event23  event24] ; 


%%  Phase  3  (Coast  Phase) 


r£3  =  x£3(l) ; 
theta£3  =  x£3 (2) ; 
Vr£3  =  x£3C3) ; 
Vt£3  =  x£3(4) ; 


i£  isnan(r£)  ==  1  |  |  isnan ( theta£)  ==  1  | |  isnan(V£_mag)  ==  1  |  |  isnan( 
t£l)  ==  1  I  I  isnan(phi)  ==  1  ... 

I  I  isnan(r£2)  ==  1  |  |  isnan(theta£2)  ==  1  |  |  isnan (V£_mag2 )  ==  1 
II  isnan(t£2)  ==  1  | |  isnan(phi2)  ==  1  ... 

I  I  isnan (t2_exit) 
event31  =  NaN; 

else 

event31  =  t£3  -  Ct£l+t2_exit/TU) ; 


end 

event3_link_state  =  xQ4  -  x£3 ; 
event3_link_time  =  tQ4  -  t£3 ; 


output . event group (3) . event  =  [event 3_link_st ate  event 3 _link_ time  event 3 1 

]; 

%%  Phase  4  (Third  Maneuver) 


r£4  =  x£4(l) ; 
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theta£4  =  xf4 (2) ; 
Vr£4  =  x£4C3)  ; 
Vt£4  =  x£4(4) ; 


%position  and  velocity  o£  initial  intercept  in  peri£ocal  £rame  o£ 
initial 
%orbit 

i£  isnan(r£)  ==  1  | |  isnan ( theta£)  ==  1  | |  isnan(V£_mag)  ==  1  | |  isnan( 
t£l)  ==  1  I  I  isnan(phi)  ==  1  ... 

I  I  isnan(r£2)  ==  1  |  |  isnan(theta£2)  ==  1  |  |  isnan (V£_inag2 )  ==  1 
II  isnan(t£2)  ==  1  | |  isnan(phi2)  ==  1  ... 

I  I  isnan(t£3)  ==  1  |  |  isnanCVr£3)  ==  1  |  |  isnan(Vt£3)  ==  1  |  | 
isnan(theta£3)  ==  1  | |  isnan(r£3)  ==  1 


event4 1 

=  NaN; 

event42 

=  NaN; 

event45 

=  NaN; 

event43 

=  NaN; 

event44 

=  NaN; 

else 


%apogee  and  perigee  constraints  at  terminus  o£  third  phase 
V£_mag3  =  sqrt(Vr£3''2  +  Vt£3''2); 

£pa3  =  atan(Vr£3/Vt£3) ; 


%peri£ocal  velocity  at  terminus  o£  thrid  phase 

vt3  =  V£_mag3 * [- sin(theta£3 -£pa3) ; cos (theta£3 - £pa3) ; Q]  ; 


rt3  =  [r£3*cos (theta £3) ; r£3*  sinCtheta£3) ; 0] ; 


[rt_i jk3 , vt_i jk3]  =  PQW_to_I JK (rt3 , vt3 , inc , RAAN , w) ; 
rt_ijk3  =  rt_ijk3*DU; 
vt_ijk3  =  vt_ijk3*DU/TU; 
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[r4 , v4 , t4]  =  zone_entry_exit2  Crt_i jk3 , vt_i jk3 , GMSTO  +  OmegaEarth* (t£3) 


''TU  ,  0  ,  latlim  ,  longlim)  ; 

[r£_pqw4  ,  v£_pqw4]  =  I  JK_to_PQW  (r4  ,  v4  ,  inc  ,  RAAN  ,  w)  ; 

r£_pqw4  =  r£_pqw4/DU; 

v£_pqw4  =  v£_pqw4/DU''TU ; 

vunit4  =  v£_pqw4/norm(v£_pqw4) ; 
h£p4  =  cross (r£_pqw4 , v£_pqw4) ; 
hunit4  =  h£p4/norm(h£p4) ; 

gunit4  =  cross (vunit4 , hunit4) ; 

terml4  =  (bel*cosCphi3)) ''2  +  Cael*sinCphi3))  "2  ; 
re4  =  ael''bel/sqrtCterinl4)  ; 

rt4  =  r£_pqw4  +  re4''cos  (phi3)  *vunit4  +  re4* sin  (phi  3 ) ''gunit4  ; 

%£inal  position  constraints 
event41  =  r£4*cos Ctheta£4)  -  rt4(l); 

event42  =  r£4*sin(theta£4)  -  rt4(2); 

%apogee  and  perigee  constraints 
V£_inag4  =  sqrt(Vr£4''2  +  Vt£4''2); 

£pa4  =  atan(Vr£4/Vt£4) ; 

%peri£ocal  velocity 

vt4  =  V£_mag4 ''  [  -  sin  ( theta£4  -  £pa4)  ;  cos  (theta£4  -  £pa4)  ;  Q]  ; 

[a4 , ecc4  =  RV2C0E_MU Crt4 , vt4  ,  MU2 )  ; 
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Ra4  =  a4*(l+ecc4); 
Rp4  =  a4*(l-ecc4)  ; 


event43  =  Ra4 ; 
event44  =  Rp4 ; 


event45  =  t£4  -  (tf3  +  t4/TU) ; 

end 


output . eventgroup (4) . event  =  [event41  event42  event45  event43  event44] ; 
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Appendix  F :  Code  for  Geostationary  Transfer  Maneuvers 


F.l  Three  Target  GTMEI 
F.1.1  Enumeration  Script 


%% 


%maximum  number  of  entries  into  exclusion  zone  before  maneuver  is 

%required 

close  all 

%  clear  all 

clc 

el_val_pass  =  Q; 
el_val_shadow  =  1; 

GMSTQ  =  0; 
lat_site  =  pi/4; 
long_site  =  8; 
t8  =  8; 

tf_max  =  36*3688; 
tstep  =  1; 
r_cyl  =  1; 
xmin  =  1; 
xmax  =  3 ; 

%design  variables 

%entry  and  exit  locations  on  relative  lobe 
%  psi8  =  8; 

%  psif  =  pi ; 

%  x_cyl_in  =  5 ; 

%  x_cyl_out  =  xmin; 

% 
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%  coast®  =  0; 
%  coastf  =  0; 


wgs84data 

global  MU  OmegaEarth  RE 

%%  Determine  Chief  Satellite  Entry/Exit  over  Exclusion  Zone 

%Initial  COEs  of  chief  satellite 
a_chief_vec  =  [26581.76  7378  6878]; 
e_chief  =  0; 
i_chief  =  55*pi/180; 

0_chief  =  0; 
o_chief  =  0; 

%  nu_chief_vec  =  0; 
nu_chief  =  0; 

chief_params  =  [e_chief ; i_chief ; 0_chief ; o_chief ; nu_chief ] ; 

%Initial  COEs  of  deputy  satellite 

a_dep  =  6578; 

e_dep  =  0; 

i_dep  =  55*pi/180; 

0_dep  =  0; 
o_dep  =  0; 
nu_dep0  =  0; 

dep_params  =  [a_dep ; e_dep ; i_dep ; 0_dep ; o_dep] ; 

a_GE0  =  42164. 14; 
e_GE0  =  0; 
i_GE0  =  0; 
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0_GE0  =  0; 
o_GE0  =  0; 

GE0_parains  =  [a_GE0  ;  e_GE0  ;  i_GE0  ;  0_GE0  ;  o_GE0]  ; 


for  aa  =  1 : length (a_chie£_vec) 

[C_times_c , C_ind_c , Ri jk_c , Vijk_c , “ , “ , rho_vec_cw_c , Tvec_c , “ , = 
contact_ times (a_chie£_vec (aa) , i_chie£ , e_chie£ , 0_chie£ , o_chie£ , 
nu_chie£  ,  long_site  ,  GMST0  ,  t£_max  +  16''3600  ,  tstep  ,  lat_site  , 
el_val_pass) ; 

val_ind  =  find (C_times_c ( : , 1)  <  t£_max) ; 

max_coast£  =  C_times_c (max (val_ind) +1 , 1) -  C_times_c (max (val_ind) , 2) ; 
C_times_c  =  C_times_c (val_ind , : ) ; 

[max_ind,“]  =  size (C_times_c) ; 

ThreePassEnumData (aa) . times  =  C_times_c ; 

ThreePassEnumData (aa) . ind  =  C_ind_c ; 

ThreePassEnumData (aa) . Rc  =  Ri jk_c ; 

ThreePassEnumData (aa) . Vc  =  Vi jk_c ; 

ThreePassEnumData (aa) . rho_c  =  rho_vec_cw_c ; 

ThreePassEnumData (aa) . Tc  =  Tvec_c ; 

ThreePassEnumData (aa) .max_ind  =  max_ind; 

ThreePassEnumData (aa) .max_coast£  =  max_coast£; 

clear  C_times_c  C_ind_c  Rijk_c  Vijk_c  rho_vec_cw_c  Tvec_c  max_ind 
max_coast£ 

end 

save ( ’ C ; \Users\Dan  Showalter\Documents\MATLAB\PSO\Relative  Motion\ 
Article_Data\Rev2\ThreePassEnumData . mat ’ , ’ThreePassEnumData’) 

for  bb  =  3:3 
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C_times_c  =  ThreePassEnumData (bb) . times ; 
C_ind_c  =  ThreePassEnumData (bb) . ind ; 

Ri jk_c  =  ThreePassEnumData (bb) . Rc ; 

Vi jk_c  =  ThreePassEnumData (bb) . Vc ; 
rho_vec_cw_c  =  ThreePassEnumData (bb) . rho_c ; 
Tvec_c  =  ThreePassEnumData (bb) . Tc ; 
max_ind  =  ThreePassEnumData (bb) .max_ind; 


a_chie£  =  a_chie£_vec (bb) ; 
i£  C_times_c (1 , 1)  ==  0 
min_start  =  2; 

else 

min_start  =  1; 

end 

£or  cc  =  14:max_ind 
i£  cc  ==  14 

startval  =  19; 

else 

startval  =  1; 

end 

£or  dd  =  startval  :20 

tstart  =  tic; 

%Period  o£  Chie£  satellite’s  orbit 
Pc  =  2*pi*sqrt  (a_chie£''3/MU)  ; 


t_enter  =  C_times_c (cc  ,  1)  ; 
t_exit  =  C_times_c (cc  ,  2) ; 
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t_zone  =  t_exit  -  t_enter: 

%determine  indices  of  minimum  duration  contact 
C_ind_contact  =  C_ind_c (cc  ,  : )  ; 

%find  unit  vector  pointing  towards  the  deputy  that  puts 
chief  between 
%ground  site  and  deputy 

rho_unit_cw  =  rho_vec_cw_c ( : , C_ind_contact ( 1) : C_ind_contact 

(2))  ; 


%determine  alpha  and  beta  angles  during  contact  times 
[alphavec , betavec]  =  alphabeta (rho_unit_cw) ; 


%Vector  of  times  for  propogation 

T_prop  =  Tvec_c (C_ind_contact (1) : C_ind_contact (2) )  -  Tvec_c( 
C_ind_contact (l))*onesClength(Tvec_c (C_ind_contact (1) : 
C_ind_contact (2) ) ) , 1) ; 


%Determine 

intial 

%contact 

chief_pos0 

chief_velO 

chief_posf 

chief_velf 


position/velocity  vectors 
/final 


=  Rijk_c( 
=  Vijk_c( 
=  Rijk_c( 
=  Vijk_c( 


, C_ind_c 
, C_ind_c 
, C_ind_c 
, C_ind_c 


(cc,l)) 

(cc,l)) 

(cc,2)) 

(cc,2)) 


of  chief  satellite  upon 


if  cc  <  max_ind 

max_coastf  =  C_times_c (cc+1 , 1)  -  C_times_c (cc , 2) ; 

else 

max_coastf  =  ThreePassEnumData (bb) . max_coastf ; 

end 
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%tiine  variables  have  precision  to  1  second.  Others  have 
%precision  to  Q.OOl  units  (km, rad) 
prec2  =  [2 ; 0 ; 3 ; 3 : 0 ; 2 ; 8 ; 6] ; 


[Jmin , ~ , gbest , ~ ,k, 3G]  =  PS0_REL_SHAD0W_DV4 (7 , [8  2*pi:l 

C_times_c (cc , 1) ; xmin  xmax ; xmin  xmax ; 1  max_coast£;8  2*pi 
; 1  16*3688] , prec2 , 588 , 388 , chief_pos8 , chief_vel8 , 
chief_posf , . . . 

chie£_vel£ , dep_params , GE0_params , alphavec , betavec , t_zone 
, Pc , t_enter , t_exit , r_cyl , T_prop , GMST8 , lat_site , 
long_site , tstep , el_val_shadow) ; 

tend  =  toc(tstart); 

in£vec  =  £ind(JG  ==  In£) ; 

in£tot  =  length(in£vec) ; 

£id  =  £open( ’ C : \Users\Dan  Showalter\Documents\MATLAB\PSO\ 
Relative  Motion\Article_Data\Rev2\ 
ThreePassEnumerationSat3 . txt ’  ,  ’  a ’ ) ; 

£print£(£id , ’ %2 i  \t\t  %2i  \t\t  %2i  \t\t  %3.2£  \t\t  %6i  \t\t 
%4.3£  \t\t  %4.3£  \t\t  %6i  \t  %3.2£  \t\t  %6i  \t\t  %6.5£  \ 
t\t  %5i  \t\t  %5i  \t\t  %6 . 2 £\r\n dd , bb , cc , gbest (1) , gbest 
(2)  ,  gbest  (3)  ,  gbest  (4)  ,  gbest  (5)  ,  gbest  (6)  ,  gbest  (7)  ,lmin,k, 
in£tot , tend) ; 


end 

end 

end 


371 


1 

2 

3 

4 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 


F.1.1.1  Determine  Target  Contact  Times  with  Ground  Site 

function  [C_times , C_ind , ri jk , vi jk , rgs , rho_sez , rho_RIC , tvec , uvec , 

long_site , nu_vec]  =  contact_times (a , inc , ecc , Omega , omega , nu0 , lambda® , 
GMSTO , tmax , tstep , lat_site , el_val) 


%INPUTS 

%  a  -  satellite  semimajor  axis  (km) 

%  inc  =  satellite  inclination  (rad) 

%  ecc  =  satellite  eccentricity 
%  Omega  =  satellite  RAAN  (rad) 

%  omega  =  satellite  argument  of  perigee  (rad) 

%  nuO  =  initial  true  anomaly  (rad) 

%  lambda®  =  initial  GMST  of  ground  site 
%  tmax  =  maximum  scenario  time  (sec) 

%  tstep  =  time  step  (sec) 

%0UTPUTS 

%  C_times  =  times  satellite  is  in  contact  with  the  ground  site 
%  C_ind  =  indices  of  satellite  contat  times 
%  rijk  =  position  vectors  of  satellite  at  discretized  times 
%  vijk  =  velocity  vectors  of  satellite  at  discretized  times 
%  rgs  =  position  vectors  of  the  ground  site  at  discretized  times 
%  rho_sez  =  vector  from  ground  site  to  satellite  in  SEZ  coordinates 
%  rho_RIC  =  vector  from  ground  site  to  satellite  in  RIG  coordinates 
% 


tvec  =  (® : tstep : tmax)  ’  ; 

%  determine  true  anomaly  of  spacecraft  at  each  time  step 
[nu_vec]  =  nuf_from_T0F_vec (nu® , tvec , a , ecc)  ; 
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%determine  inertial  position  and  velocity  vectors  at  each  tiem  step 
[rijk,vijk,r]  =  C0E2RV_vec (a , ecc , inc , Omega , omega , nu_vec) ; 


r  =  r  ’  ; 

wgs84data 

global  OmegaEarth  RE 

long_site  =  lambda®  +  GMSTO  +  OmegaEarth*tvec ; 

Rsite  =  zeros (3 , length (tvec) ) ; 

Rsite(l,:)  =  RE*cos  (lat_site)  .  ''cos  (long  _  site)  ; 

Rsite  (2  ,  :  )  =  RE* cos  (lat_site)  .  *sin(long_site)  ; 

Rsite(3,:)  =  RE*sin(lat_site)  ; 

rho_ijk  =  rijk  -  Rsite; 

temp  =  zeros (3 , length (tvec) )  ; 

temp (1 , : )  =  cos ( long_site ’ ) . *rho_i jk (1 , : )  +  sin(long_site ’ ) . *rho_i jk 
(2.:); 

temp (2 , : )  =  -  sin ( long_site ’ ) . *rho_i jk (1 , : )  +  cos (long_site ’ ) . *rho_i jk 
(2.:); 

temp(3,:)  =  rho_i jk  (3  ,  :  )  ; 

rho_sez  =  zeros (3 , length(tvec) ) ; 

rho_sez(l,:)  =  cos(pi/2  -  lat_site) * temp ( 1 , : )  -  sin(pi/2  -  lat_site)* 
temp  (3  ,  :)  ; 

rho_sez(2,:)  =  temp(2,:); 

rho_sez(3,:)  =  sin(pi/2  -  lat_site) * temp  ( 1 ,  : )  +  cos(pi/2  -  lat_site)* 
temp  (3  ,  :)  ; 
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ind_l  =  1 ; 

while  ind_l  ==  1 

ind7  =  find(long_site  >  2''pi)  ; 
if  isempty Cind7) 
ind_l  =  Q; 

else 

long_site (ind7)  =  long_site (ind7)  -  2*pi; 
end 


end 

uvec  =  omega  +  nu_vec; 

zone_ind  =  zeros (length(tvec)  ,  1)  ; 
num_in  =  0; 

%inertial  coordinates  of  ground  site 

rgs  =  zeros (3 , lengthCtvec) ) ; 

rgs  (1  ,  :  )  =  RE*cos (lat_site) *cos (long_site  ’  )  ; 

rgs  (2  ,  :  )  =  RE*cos ( lat_site ) *  sin (long_site  ’  )  ; 

rgs(3,:)  =  RE '' sin ( lat_site )  ; 

%vector  from  ground  site  to  satellite 
rho_ijk  =  rijk  -  rgs; 
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%transform  into  sez  coordinates 


temp  =  zeros (3 , length (tvec) ) ; 

temp  (1 ,  : )  =  cos  ( long_site  ’  )  .  ''rho_i  jk  (1 ,  :  )  +  sin(long_site  ’  )  .  *rho_i  jk 
(2.:); 

temp  (2  ,  : )  =  -  sin  ( long_site  ’  )  .  *rho_i  jk  (1 ,  :  )  +  cos  (long_site  ’  )  .  ''rho_i  jk 
(2.:); 

temp(3,:)  =  rho_i j k  (3  ,  :  )  ; 

rho_sez  =  zeros (3 , length(tvec) ) ; 

rho_sez(l,:)  =  cos(pi/2  -  lat_site) '' temp  ( 1  ,  : )  -  sin(pi/2  -  lat_site)* 
temp  (3  ,  ; 

rho_sez(2,:)  =  tempC2,:); 

rho_sez(3,:)  =  sin(pi/2  -  lat_site)  *  temp  ( 1  ,  : )  +  cosCpi/2  -  lat_site)'' 
temp  (3  ,  ; 

rho_mag  =  sqrt (rho_sez (1 , : ) . " 2  +  rho_sez (2 , : ) . "2  +  rho_sez (3 , : ) . " 2) ; 

el_vec  =  asind(rho_sez  (3  ,  :  )  .  /i’ho_mag)  ; 

for  aa  =  1 : length (tvec) 

if  el_vec(aa)  >  el_val 
zone_ind(aa)  =  1; 
if  aa  ==  1 

num_in  =  num_in  +  1; 

C_times (num_in , 1)  =  tvec(aa); 

C_ind (num_in , 1)  =  aa ; 

else 

if  zone_ind(aa  -  1)  ==  0 
num_in  =  num_in  +  1 ; 
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C_times (num_in , 1)  =  tvec(aa); 


C_ind (num_in ,1)  =  aa ; 

end 

end 

else 

zone_ind(aa)  =  0; 
if  aa  “=  1 

if  zone_ind(aa  -  1)  ==  1 

C_times (num_in , 2)  =  tvec(aa-l); 

C_ind  (num_in  ,  2)  =  aa  -  1 ; 

end 

end 

end 

if  aa  ==  length(tvec)  &&  zone_indCaa  -1)  ==  1 
C_times (num_in , 2)  =  tvec(aa); 

C_ind(num_in , 2)  =  aa; 

end 

end 

%convert  ijk  to  RIC 

temp2  =  zeros (3 , length (tvec) ) ; 

temp 2  (1  ,  :  )  =  cos  (Omega)  ''rho_ij  k  ( 1  ,  :  )  +  sinCOmega)  *rho_i  jk  (2  ,  :  )  ; 
temp 2  (2  ,  :  )  =  cos  (Omega)  ''rho_i  jk  (2  ,  :  )  -  sin(Omega)  *rho_i  jk  (1  ,  :  )  ; 
temp2(3,:)  =  rho_i jk  (3  ,  :  )  ; 

temp3  =  zeros (3 , length (tvec) ) ; 
temp3(l,:)  =  temp2(l,:); 

temp3(2,:)  =  cos (inc) *temp2 (2 , : )  +  sin(inc) *temp2 (3 , : ) ; 
temp3(3,:)  =  cos (inc) *temp2 (3 , : )  -  sin(inc) *temp2 (2 , : ) ; 

rho_RIC  =  zeros (3 , length(tvec) ) ; 
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rho_RIC(l,:)  =  cos (uvec ’ ) . * tempS ( 1 , : )  +  sin (uvec ’ ) . * temp3 (2 , : ) ; 


rho_RIC  (2  ,  :  )  =  cos  (uvec  ’  )  .  *  temp  3  (2  ,  :  )  -  sin  (uvec  ’  )  .  ''temp  3  (1  ,  :  )  ; 
rho_RIC(3,:)  =  temp3(3,:); 

norm_vec  =  sqrt  (rho_RIC  (1 ,  :  )  .  "  2  +  rho_RIC  (2  ,  :  )  . 2  +  rho_RIC  (3  ,  :  )  .  "  2)  ; 

rho_RIC (1 , : )  =  rho_RIC (1 , : ) . /norm_vec ; 
rho_RIC (2 , : )  =  rho_RIC (2 , : ) . /norm_vec ; 
rho_RIC (3 , : )  =  rho_RIC (3 , : ) . /norm_vec ; 

i£  num_in  ==  0 
C_times  =  0; 

C_ind  =  0; 

end 

FI, 1,2  Determine  Final  True  Anomaly  Given  Time  of  Flight 

function  [nuf ]  =  nu£_£rom_T0F_vec (nuO , T0F_vec , a , e) 

wgs84data 
global  MU 

nuf  =  zeros (length (T0F_vec)  ,  1)  ; 

Eg  =  zeros (length (T0F_vec)  ,  1)  ; 


%%  1)  compute  orbital  mean  motion 
n  =  sqrt (MU/abs (a) " 3) ; 


%%  2)  convert  initial  true  anomaly  to  initial  mean  anomaly 
if  e  <  1 

if  nuO  ==  0; 
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MO  =  0; 


elseif  nuO  ==  pi 


MO  =  pi ; 


else 


EO  =  acos ( (e+cos (nuO) ) /( l+e*cos (nuO) ) ) ; 


if  (nuO  >  pi) 


EO  =  2*pi  -  EO ; 


end 


MO  =  EO  -  e*sin(EO); 


end 


MO  =  MO*ones (length(TOF_vec)  ,  1) ; 


%%  3)  compute  final  mean  anomaly 
Mold  =  MO  +  n*TOF_vec; 

N  =  Mold/(2*pi) ; 

Mf  =  Mold  -  floor  (N)  *2 ''pi  ; 


Mflag  =  1; 


378 


49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 

61 

62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 

74 

75 

76 

77 

78 

79 

80 


while  Mflag  ==  1 

ind_M£  =  findCMf  >  2''pi)  ; 

if  isempty (ind_M£)  ==  0 

M£(ind_M£)  =  M£(ind_M£)  -  2''pi; 

else 

Mflag  =  0; 

end 


end 


ind_Egl  =  £ind(M£  >  pi); 
ind_Eg2  =  £ind(M£  <=  pi); 

Eg(ind_Egl)  =  M£Cind_Egl)  -  e; 

Eg(ind_Eg2)  =  M£(ind_Eg2)  +  e; 

Ef  =  Eg  +  (Mf  -  Eg  +  e* sin (Eg) ) . / ( 1  -  e*cos(Eg)); 

Eflag  =  1 ; 

while  Eflag  ==  1 

diff  =  abs(Ef  -  Eg); 

ind_E£  =  findCdiff  >  le-8); 

if  isempty (ind_Ef)  ==  0 
Eg  =  E£; 

E£  =  Eg  +  (Mf  -  Eg  +  e *  sin (Eg) ) . / ( 1  -  e*cos(Eg)); 

else 
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Eflag  =  0; 


end 

end 

nu£  =  acos (Ceos (E£) -e) . /(I -e*cos (E£) ) ) ; 

ind_quad  =  £ind(E£  >  pi); 

nu£(ind_quad)  =  2*pi  -  nu£( ind_quad) ; 


elsei£  e  >  1 
%%  Hyperbolic  orbits 

sinh_H0  =  sin(nuO)  *  sqrt  (e ''2  -  1)  /  ( 1  +  e*  cos  (nu0)  )  ; 

H  =  zeros(length(TOF_vec)  ,  1)  ; 

M  =  zeros (lengthCTOF_vec)  ,  1) ; 

M0  =  e*sinh_H0  -  asinh(sinh_H0) ; 


Mold  =  M0  +  n*T0F_vec; 

N  =  Mold/(2''pi); 

M  =  Mold  -  Floor  (N) ''2*pi  ; 

i£  e  <  1.6 

H  =  M  +  e; 

indl  =  £ind(-pi  <  M  &  M  <  0)  ; 
ind4  =  £ind(M  >  pi); 

H(indl)  =  M(indl)  -  e; 

H(ind4)  =  M(ind4)  -  e; 

else 

H  =  M/(e  -  1) ; 
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if  e  <  3.6 


ind2  =  find(abs(M)  >  pi); 
if  isempty Cind2)  ==  0 

H(ind2)  =  M(ind2)  -  sign (M (ind2 ) ) *e ; 

end 

end 

end 

Hflag  =  1; 

Hg  =  H; 


while  Hflag  ==  1 

Knew  =  Hg  +  (M  -  e''sinh(Hg)  +  Hg)  .  / (e '' cosh (Hg)  -  1); 

diff  =  abs(Hnew  -  Hg) ; 

ind_H  =  find(diff  >  le-8)  ; 
if  isempty (ind_H)  ==  0 
Hg  =  Hnew ; 

else 

Hflag  =  0; 

end 

end 

sin_nu  =  C-sinh(Hnew) ''sqrtCe''2  -  1))./C1  -  e*coshCHnew) )  ; 

cos_nu  =  (cosh(Hnew)  -  e) ./(l-e*cosh(Hnew)) ; 

nuf  =  atan2 (sin_nu , cos_nu) ; 


end 
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if  isrealCnuf) 


0 


a 

e 

nuO 

save  nu£ 

end 

%  if  e  ==  1 
%  keyboard 

%  end 

%  zer_val  =  find(nuf  ==  0) ; 
%  if  zer_val  ==  length(nuf) 
%  keyboard 

%  end 


F.l.l.S  Determine  State  Given  COEs 

function  [R_i  jk  ,  V_i  jk  ,  r]  =  C0E2RV_vec  (a  ,  ecc  ,  inc  ,  RAAN  ,  w  ,  nu_vec) 

%Author :  Dan  Showalter  18  Oct  2012 

%Purpose:  find  inertial  position  and  velocity  vector  gievn  classical 
%orbital  elements 

%%  Algorithm 
MU  =  398600.5; 

dim  =  length(nu_vec) ; 

p  =  a*(l-ecc''2)  ; 

r  =  p ./(l+ecc*cos(nu_vec)) ; 
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R_pqw  =  zeros (3, dim) 
V_pqw  =  zerosC3,dim) 
R_ijk  =  zeros(3,dim) 
V_ijk  =  zeros(3,dim) 


R_pqw(l,:)  =  (r . *cos Cnu_vec) ) ’ ; 

R_pqw(2,:)  =  (r . *  sin Cnu_vec ) ) ’ ; 

V_pqw  (1  ,  :  )  =  sqrt (MU/p) * (- sin (nu_vec)  ’  ) ; 

V_pqw (2 , : )  =  sqrt (MU/p)*(ecc  +  cos  Cnu_vec) ) ’ ; 

%first  rotation  about  vertical  axis  by  -w 
R_templ(l,:)  =  cos (-w) *R_pqw (1 , : )  +  sin (-w) *R_pqw (2 , : ) ; 
R_templ(2,:)  =  cos (-w) *R_pqw (2 , : )  -  sin (-w) *R_pqw ( 1 , : ) ; 
R_templ(3,:)  =  R_pqw(3,:); 

V_templ(l,:)  =  cos (-w) *V_pqw (1 , : )  +  sin (-w) *V_pqw (2 , : ) ; 
V_templ(2,:)  =  cos (-w) *V_pqw (2 , : )  -  sin (-w) * V_pqw ( 1 , : ) ; 
V_templ(3,:)  =  V_pqw(3,:); 

%2nd  rotation  about  primary  axis  by  -inc 
R_temp2(l,:)  =  R_temp 1 ( 1 , : ) ; 

R_temp2  (2  ,  :  )  =  cos  (-inc)  ''R_templ  (2  ,  :  )  +  sin  (-  inc)  *R_templ  (3  ,  :  )  ; 

R_temp2  (3  ,  :  )  =  cos  (-inc)  ''R_templ  (3  ,  :  )  -  sin  (-  inc)  *R_templ  (2  ,  :  )  ; 

V_temp2(l,:)  =  V_temp 1 ( 1 , : ) ; 

V_temp2  (2  ,  :  )  =  cos  (-inc)  ''V_templ  (2  ,  :  )  +  sin  (-  inc)  *  V_templ  (3  ,  :  )  ; 

V_temp2  (3  ,  :  )  =  cos  (-inc)  ''V_templ  (3  ,  :  )  -  sin  (-  inc)  *  V_templ  (2  ,  :  )  ; 

%3rd  rotation  about  vertical  axis  by  -RAAN 
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R_i  jk  (1  ,  :  )  =  cos  (-RAAN)  ''R_temp2  ( 1  ,  :  )  +  sin  (-RAAN)  *R_temp2  (2  ,  :  )  ; 

R_i  jk  (2  ,  :  )  =  cos  (-RAAN)  ''R_temp2  (2  ,  :  )  -  sinC-RAAN)  *R_temp2  (1  ,  :  )  ; 

R_ijk(3,:)  =  R_temp2 (3  ,  :  )  ; 

V_i  jk  (1  ,  :  )  =  cos  (-RAAN)  ''V_temp2  ( 1  ,  :  )  +  sinC-RAAN)  *  V_temp2  (2  ,  :  )  ; 

V_i  jk  (2  ,  :  )  =  cos  (-RAAN)  ''V_temp2  (2  ,  :  )  -  sin  (-RAAN)  *  V_temp2  (1  ,  :  )  ; 

V_ijk(3,:)  =  V_temp2 (3  ,  ; 

FI, 1,4  Inner  Loop  PSO  Algorithm 

function  [ JGmin , Jpbest , gbest , x , k , 3G , ex_£lag]  =  PS0_REL_SHAD0W_DV4 (n , 
limits , prec , iter , swarm , chie£_pos® , chie£_vel® , chie£_pos£ , chie£_vel£ , 
dep_params  ,  GEO_params  ,  alphavec  ,  betavec  ,  t_zone  ,  Pc  ,  T_enter  ,  T_exit  ,  .  .  . 

r_cyl , T_prop 
,GMST(S)  , 
lat_site 

) 

long_site 
, t_step  , 
el_val) 


%Author :  Dan  Showalter  18  Oct  2812 

%Purpose :  Utilize  PSO  to  solve  multi -orbit  sinegle  burn  maneuver  problem 

%generic  PSO  variable 
%  n:  #  of  design  variables 

%  limits:  bounds  on  design  variables  (n  x  2  vector)  with  first  element 
%  in  row  n  being  lower  bound  for  element  n  and  2nd  element  in  row 

n  being 

%  upper  bound  for  element  n 
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places  to  keep  for  each  design 
evalution  size:  Cn+1,1) 

%Problem  specific  PSO  variables 


%Specific  Problem  Variables 


%  iter:  number  of  iterations 

%  swarm:  swarm  size 

%  prec :  defines  the  number  of  decimal 
%  variable  and  the  cost  function 


%% 


[N,“]  =  size (limits) ; 


Him  = 

limits ( : 

,1) 

ulim  = 

limits ( : 

,2) 

if  N“=n 

fprintf C ’ Error !  limits  size  does  not  match  number  of  variables’) 
stop 

end 


gbest  =  zerosCn,!); 

X  =  zeros (n , swarm) ; 

V  =  zeros (n , swarm) ; 
pbest  =  zeros (n , swarm) ; 
Jpbest  =  zeros (swarm  ,  1)  ; 


385 


47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 

61 

62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 

74 

75 

76 

77 

78 


d  =  (ulim  -  Him)  ; 

JG  =  zeros  (iter  ,  1)  ; 

J  =  zeros (swarm  ,  1)  ; 

llim2  =  ones (n , swarm) ; 
ulim2  =  ones (n , swarm) ; 

for  aa  =  l:n 

llim2 (aa , : )  =  llim(aa) * llim2 (aa , : ) ; 
ulim2(aa,:)  =  ulim(aa) ''ulim2  (aa  ,  :  )  ; 

end 

d2  =  ulim2  -  llim2 ; 

CoreNum  =  12 ; 

if  (matlabpool ( ’ size  * ) ) <=® 

matlabpool ( ’ open  * , Hocal ’ , CoreNum) ; 

else 

disp (’ Parallel  Computing  Enabled ’ ) 

end 

tstart  =  tic; 

%loop  until  maximum  iteration  have  been  met 

for  k  =  1 : iter 

%create  particles  dictated  by  swarm  size  input 


%  if  this  is  the  first  iteration 
if  k  ==  1 

rng(’ shuffle*); 

X  =  random( * unif llim2 , ulim2 , [n , swarm] ) ; 
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V  =  random C ’ uni£ ’ , -d2 , d2 , [n , swarm] ) ; 


else 


%i£  this  is  a£ter  the  £irst  iteration,  update  velocity  and 
position 

%o£  each  particle  in  the  swarm 

parfor  h  =  1 : swarm 
cl  =  2.09; 
c2  =  2.09; 
phi  =  cl+c2; 

ci  =  2/abs(2-phi  -  sqrt(phi''2  -  4*phi))  ; 
cc  =  cl*random( ’ unif ’  ,  0 , 1) ; 
cs  =  c2*random( ’unif ’  ,0 , 1) ; 


vdum  =  v( : , h) ; 

%update  velocity 
vdum  =  ci*(vdum  +  cc* (pbest ( : , h) 
(:  ,h)))  ; 


x(:,h))  +  cs*(gbest 


%check  to  make  sure  velocity  doesn’t  exceed  max  velocity  for 
each 
%variable 
for  w  =  l:n 

%if  the  variable  velocity  is  less  than  the  min,  set  it 
to  the  min 
if  vdum(w)  <  -d(w) 
vdum(w)  =  -d(w) ; 

%if  the  variable  velocity  is  more  than  the  max,  set 
it  to  the  max 
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elseif  vdumCw)  >  d(w) ; 
vdum(w)  =  d(w) ; 

end 

end 

V ( : , h)  =  vdum ; 

%update  position 
xdum  =  x(:,h)  +  v(:,h); 

for  r  =  l:n 

%i£  particle  has  passed  lower  limit 
if  xdum(r)  <  llimCr) 
xdum(r)  =  llim(r) ; 

elseif  xdum(r)  >  ulim(r) 
xdum(r)  =  ulim(r) ; 

end 

X  C :  , h)  =  xdum ; 


end 


end 


end 

%  round  variables  to  get  finite  precision 
parfor  aa  =  l:n 

X  (aa  ,  :  )  =  round  (x  (aa  ,  :)*10''(prec(aa)))/lQ''precCaa)  ; 
v(aa  ,  :  )  =  round  (v(aa  ,  :)*10''(prec(aa)))/lO''precCaa)  ; 
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138  end 

139 

140  %%  ***********************(^Q5^  Function 
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148  % 

149  % 

150  % 

151  % 

152  % 

153 

154 


xmin  =  limits (2,1); 

%  rel_pos  =  zeros (3 , length(T_prop) ) ; 

%  rel_pos_box  =  zeros (3 , length (T_prop) ) ; 

%  tempi  =  zeros  (1 ,  length  (T_prop)  )  ; 

%  temp2  =  zeros  (1 ,  length  (T_prop)  )  ; 

%  temp3  =  zeros (1 , lengthCT_prop) ) ; 

fcloseC’all  ’)  ; 
fid=fopen ( ’ K-M . txt ’  ,  ’ w  ’  ) ; 

fprintf (fid , ’ \r\n\r\n\r\n\r\n%s  %i ’ , ’ K ’ , k) ; 
fid2  =  fopen( ’ optvals . txt ’ , ’ w ’ ) ; 

£print£(fid2 , ’ \r\n\r\n\r\n%s  %i ’ , ’K’ ,k) ; 
parfor  m  =  1 : swarm 

o/^  **************** function  evaluation  here 


155  opt_vars  =  x(:,m); 

156  %  £id2  =  fopen  (’ optvals  .  txt a ’)  ; 

157  %  £print£(£id2  ,  ’\r\n%i\t%6.2f  %6.3£  %6.3£  %6.2£\t  %6.3£  %6.2£\t 

’ , m , opt_vars ( 1) , opt_vars (2) , opt_vars (3) ,opt_vars(4) ,opt_vars(5) , 
opt_vars  (6) )  ; 

158  %  fclose  (£id2)  ; 

159  [J(rri)]  =  rel_shadow_cost_function2  (opt_vars  ,  chie£_posQ  , 

chie£_velO , chie£_pos£ , chie£_vel£ , alphavec , betavec , t_zone , Pc , 
T_prop , xmin , r_cyl , dep_params  ,  . . . 

160  GE0_params  ,  T_enter  , 

T_exit , GUSTO  , 
long_site  , 
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lat_site , t_step 
el_val)  ; 

161  % 

162  % 

163  %  fid=£open(  ’  K-M .  txt  ’  ,  ’  a  ’  ) 

164  %  fprint£(£id  ,  ’ \r\n%s  %i  %8.5£’,’M  complete  ’  ,m,  D  (m))  ; 

165  %  £close  (£id)  ; 

166 

167  end 

168 

169  %%  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *******  C  o  n  s  t  r  a  i  n  t  Equations 


170  %% 

171  %% 

172 

173 

174  %round  cost  to  nearest  precision  required 

175  J  =  roundC J  *  1Q“ prec  (n+1)  ) /lO" prec  (n+1)  ; 

176 

177  i£  k  ==  1 

178  count  =  8; 

179  Jpbest  (1 :  swarm)  =  1(1:  swarm); 

180  pbest  (:,  1 :  swarm)  =  x  (:,  1 :  swarm)  ; 

181 

182  [Jgbest,IND]  =  min(lpbest  (  :  )  )  ; 

183 

184  gbest(:)  =  x(:,IND): 

185 

186  else 

187 
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for  h=l : swarm 


if  J (h)  <  Jpbest(h) 

Jpbest (h)  =  J (h) ; 
pbest(: ,h)  =  x(: ,h) ; 
if  Jpbest(h)  <  Jgbest 

Jgbest  =  JpbestCh); 
gbest  (:)  =  x(:  ,h) ; 


end 


end 

end 

end 


diff  =  zeros (swarm  ,  1)  ; 
parfor  y  =  1 : swarm 

diff(y)  =  Jgbest  -  JpbestCy); 

end 

indcount  =  find(abs(diff)<10''  (-prec (n+1)  ) )  ; 


JG(k)  =  Jgbest ; 
JGmin  =  Jgbest ; 


kinf  =  50; 
if  k  >  kinf 
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%  if  Jgbest  ==  Inf 

%  break 

%  end 

%  end 

if  length(indcount)  ==  swarm 
ex_flag  =  0; 
break 

end 

if  k  >  1 

if  JGCk)  ==  JG(k-l) 

count  =  count  +  1; 

else 

%  MinCost  =  Jgbest*1000 

%  k 

count  =  0; 

end 

end 

if  count  >  1000 
ex_flag  =  1; 
break 

end 

end 

if  k  ==  iter 

ex_flag  =  2; 

end 

FI, 1,5  Cost  Function  Script 
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function  [J]  =  rel_shadow_cost_£unction2 (opt_vars , chie£_pos0 , chie£_vel0 , 
chie£_pos£ , chie£_vel£ , alphavec , betavec , t_zone , Pc , T_prop , xmin , r_cyl , 


dep_params  ,  .  . . 


GE0_params , 
T_enter  , 
T_exit  , 
GMST0  , 
long_site 
) 

lat_site 
, t_step  , 
el_val) 


OmegaEarth^Q.  00(5(97292  115  1467; 
RE=6378. 137; 

%  variable  definitions 

%  nuO  =  opt_vars(l); 

%  TOFl  =  opt_vars(2); 

%  x_in  =  opt_vars(3); 

%  x_out  =  opt_vars(4); 

%  coast3  =  opt_vars(5); 

%  nu_GEO  =  opt_vars(6); 

%  Tend  =  opt_vars(7); 

alphaO  =  alphavec (1); 
betaO  =  betavec  (1); 
alphaf  =  alphavec (end) ; 
betaf  =  betavec (end) ; 

a_dep  =  dep_params  (1) ; 
e_dep  =  dep_params  (2) ; 
i_dep  =  dep_params  (3)  ; 
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0_dep  =  dep_params  (4)  ; 
o_dep  =  dep_params  (5)  ; 

a_GEO  =  GEO_params  (1)  ; 
e_GE0  =  GE0_params  (2)  ; 
i_GE0  =  GEO_params  (3)  ; 
0_GE0  =  GEO_params  (4) ; 
o_GE0  =  GE0_params  (5)  ; 


%determine  entry  and  exit  conditions  of  deputy  in  cylinder  frame 

box_vec6)  =  zerosC3,l); 

box_vec0(l)  =  opt_vars(3); 

box_vec0(2)  =  0; 

box_vec0(3)  =  0; 

[deputy_pos0 , rel_pos0]  =  box2cw (chief_pos0 , chief_vel0 , box_vec0 , alpha0 , 
beta0) ; 

box_vecf  =  zerosC3,l); 
box_vecf(l)  =  opt_vars(4); 
box_vecf(2)  =  0; 
box_vecf(3)  =  0; 

[deputy_posf , rel_posf ]  =  box2cw (chief_posf , chief_velf , box_vecf , alpha f , 
betaf ) ; 

%determine  required  entry/exit  velocities  corresponding  to  entry/exit 
conditions 

[v0_tilde , vf_tilde]  =  relative_velocity (t_zone , Pc , rel_pos0 , rel_posf ) ; 
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%propogate  (discretely)  relative  motion  for  time  chief  in  contact  with 
%ground  site 

[rel_pos]  =  CW_]yiotion3  (rel_posO  ,  v®_tilde  ,  T_prop  *  ,  Pc)  ; 

%convert  relative  position  from  cw  to  cylinder  frame 
tempi  =  cos  (betavec)  .  *rel_pos  (1 ,  :  )  +  sin  (betavec)  .  ''rel_pos  (2  ,  :  )  ; 
temp 2  =  cos  (betavec)  .  ''rel_pos  (2  ,  :  )  -  sin  (betavec)  .  ''rel_pos  (1 ,  :  )  ; 
temp3  =  rel_pos  (3  ,  : )  ; 

rel_pos_box  =  zeros (3 , length (rel_pos))  ; 

rel_pos_box (1 , : )  =  cos (- alphavec) . *  tempi  -  sin(- alphavec) . *  temp 3 ; 
rel_pos_box  (2  ,  :  )  =  temp2 ; 

rel_pos_box  (3  ,  :  )  =  cos  (-  alphavec)  .  *  temp  3  +  sin  (-  alphavec)  .  '"tempi ; 

[T_out]  =  out_of_cylinder (rel_pos_box , T_prop ’ , xmin , r_cyl) ; 

%propogate  (discretely)  relative  motion  for  post  inspection  motion  to 
%ensure  chaser  doesn’t  intercept  chief 
T_post_ci  =  [ (0 : opt_vars (7) )  opt_var s (7) ] ; 

[rel_pos2 ]  =  CW_Motion3 (rel_posf , vf_tilde , T_post_ci , Pc) ; 
rel_min_vec  =  sqrt (rel_pos2 (1 , : ) . *rel_pos2 ( 1 , : )  +  rel_pos2 (2 , : ) . * 
rel_pos2 (2  ,  : )  +  rel_pos2 (3 , : ) . *rel_pos2 (3 , : ) ) ; 

%closest  approach  must  be  more  than  50  meters  away 
min_approach  =  min (rel_min_vec) ; 

if  T_out  >  0  II  min_approach  <  0.05 
J  =  Inf; 

else 
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v0_rel  =  vO_tilde/Pc; 

[“,“,101,001,", nuoOl]  =  RV2C0E (ohie£_posO , ohie£_vel0) ; 
vO_arrive  =  ohie£_velQ  +  rot  3mat  (-Ool)  *rot  Imat  (-iol)  ''rot 3mat  (-nuoQl) 
*vO_rel ; 


%  %determine  departure  looation  o£  maneuvering  satellite 

nu_dep  =  opt_varsCl); 

[r0_d  ,  v0_d]  =  COE2RV  Ca_dep  ,  e_dep  ,  i_dep  ,  0_dep  ,  o_dep  ,  nu_dep)  ; 

%%  solve  lambert’s  problem  both  ways  to  get  £rom  satellite  to  lobe 
entry  oondition 

[VIS,  V2S]  =  lambert2  (r0_d  ’  ,  deputy_pos0  ’  ,  (  opt_vars  (2))/(3600''24) 

,0 , 398600.5) ; 

[VIL,  V2L]  =  lambert2  (r0_d  ’  ,  deputy_pos0  ’  ,  -  (opt_vars  (2))/(3600''24) 

,0 , 398600.5) ; 

%Depature  DV 
DVIS  =  VIS  -  v0_d  * ; 

DVIL  =  VIL  -  v0_d  * ; 

%arrival  DV 

DV2S  =  v0_arrive ’  -  V2S ; 

DV2L  =  v0_arrive ’  -  V2L ; 

DV_shadeS  =  normCDVlS)  +  normCDV2S) ; 

DV_shadeL  =  normCDVlL)  +  norm(DV2L) ; 

i£  DV_shadeS  <  DV_shadeL 
DV  =  DV_shadeS ; 

V12_d  =  VIS ’ ; 

DV_departl  =  DVIS  ’  ; 
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DV_arrivel  =  DV2S  ’  ; 


else 

DV  =  DV_shadeL ; 

V12_d  =  VIL ’ ; 

DV_departl  =  DVIL  ’  ; 

DV_arrivel  =  DV2L  ’  ; 

end 

%determine  ground  site  inertial  position  vectors  for  duration  of 
second  maneuver 
%(coast0  to  Tenter) 

Tvecl2  =  CT_enter -opt_vars (2) : t_step : T_enter ) ’ ; 

GMST12  =  GMST®*onesClengthCTvecl2) , 1)  +  OmegaEarth . *Tvec 12 ; 
longvecl2  =  long_site*ones (length(Tvecl2) , 1)  +  GMST12; 


%inertial  coordinates  of  the  ground  site 
Rsitel2  =  zeros (3 , length (Tvec 12 ) ) ; 

Rsitel2(l,:)  =  RE*cos (lat_site) . *  cos ( longvec 12 ) ; 
Rsitel2(2,:)  =  RE*cos (lat_site) . *  sin ( longvec 12 ) ; 
Rsitel2(3,:)  =  RE*sin(lat_site) ; 


%determine  maneuvering  spacecraft  inertial  position  vectors  for 
duration  od 
%second  maneuver 
Tvecl2m  =  Tvecl2  -  Tvecl2(l); 


[am  12  ,  eml2  ,  iml2 , 0ml2  ,  oml2  ,  num012  ]  =  RV2C0E  Cr0_d  ,  V12_d)  ; 
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if  imag Cnum012)  <  le-6 


nuin012  =  real  Cnum012)  ; 

else 

fid  =  fopen ( ’ error_data . txt ’ ,  ’  a  ’  )  ; 

, ind_imag]  =  max(imagCnum012)) ; 
fprintf (fid , * %s  %s ’ , ’ Real  * , ’ Imag ’ ) ; 

fprintf (fid , ’ \n\r%10 .8f  %10.8f’,real (num012 (ind_imag) ) , imag ( 
num012 (ind_imag))) ; 

end 


[val]  =  site_contact_vec  (am  12  ,  iml2  ,  eml2 , 0ml2  ,  oml2  ,  num012  ,  long_site  , 
GMST12  (1)  ,  Tvecl2m(end)  ,  t_step  ,  lat_site  ,  Rsitel2  ,  el_val)  ; 

T_out2  =  length(val)/length(Tvecl2m)*Tvecl2m(end) ; 

if  isempty(val)  ==  0 
J  =  Inf; 

else 


%%  3rd  and  4th  Maneuver 

vf_rel  =  vf_tilde/Pc; 

[",“,102,002,“, nuo02 ]  =  RV2C0E (ohief_posf , ohief_velf ) ; 
vf_depart  =  ohief_velf  +  rotSmat (-0o2 ) *rot Imat (- io2 ) *rot 3mat (- 
nuo02  )  ''vf_rel  ; 

%determine  orbital  parameters  of  satellite  upon  zone  exit 
[at , et , it , Ot , ot , nut0]  =  RV2C0E (deputy_posf , vf_depart) ; 
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nu_tL  =  nu£_£rom_T0F  (nut®  ,  opt_vars  (5)  ,  at ,  et)  ; 
[r_tL  ,  V_tL]  =  C0E2RV  (at ,  et ,  it ,  Ot ,  ot  ,  nu_tL)  ; 


%determine  arrival  location  o£  maneuvering  satellite 
[r_GE0  ,  V_GE0]  =  C0E2RV  (a_GE0  ,  e_GE0  ,  i_GE0 , 0_GE0  ,  o_GE0  ,  opt_vars  (6) 
); 

%%  solve  lambert’s  problem  both  ways  to  get  £rom  lobe  exit 
condition  to  GEO 

[V3S,  V4S]  =  1  amber  1 2  (r_tL  ’  ,  r_GE0  *  ,  (opt_vars  (7))/(36®®''24) 

,®  ,  398600.5) ; 

[V3L,  V4L]  =  1  amber  1 2  (r_tL  ’  ,  r_GE0  ’  ,  -  (opt_vars  (7))/(36®0''24) 
,0,398600.5) ; 

%Depature  DV 
DV3S  =  V3S  -  V_tL ’ ; 

DV3L  =  V3L  -  V_tL  ’  ; 

%arrival  DV 

DV4S  =  V_GE0’  -  V4S; 

DV4L  =  V_GE0’  -  V4L; 

DV_GE0S  =  norm(DV3S)  +  norm(DV4S) ; 

DV_GE0L  =  norm(DV3L)  +  norm(DV4L) ; 

i£  DV_GE0S  <  DV_GE0L 
V_mL  =  V3S  * ; 

DV2  =  DV_GE0S; 

DV_depart2  =  DV3S ’ ; 

DV_arrive2  =  DV4S ’ ; 
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else 


V_mL  =  V3L  * ; 

DV2  =  DV_GEOL; 

DV_depart2  =  DV3L ’ ; 

DV_arrive2  =  DV4L ’ ; 

end 

%deterinine  ground  site  inertial  position  vectors  for  duration  of 
second  maneuver 
%(Texit  +  coastf)  to  Tend 

Tvec2  =  (T_exit+opt_vars (5) : t_step : T_exit+opt_vars (5)+opt_vars 
(7))*; 

GMST  =  G]yiST®*ones  (lengthCTvec2)  ,  1)  +  OmegaEarth  .  *Tvec2  ; 
longvec  =  long_site*onesClength(Tvec2) , 1)  +  GMST; 


%inertial  coordinates  of  the  ground  site 
Rsite  =  zeros (3 , length (Tvec2 )) ; 

Rsite(l,:)  =  RE''cos  (lat_site)  .  *cos  (longvec)  ; 

Rsite(2,:)  =  RE''cos(lat_site).  *  sin  (longvec)  ; 

Rsite(3,:)  =  RE''sin(lat_site)  ; 

%determine  maneuvering  spacecraft  inertial  position  vectors  for 
duration  od 

%second  maneuver  (Texit  +  coastf)  to  Tend 
Tvec3  =  Tvec2  -  T_exit  -  opt_vars(5); 

[am  ,  em  ,  im  ,  Om  ,  om  ,  numO]  =  RV2C0E  (r_tL  ,  V_mL)  ; 

if  imag(num®)  <  le-6 
numO  =  real(numO); 
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else 


fid  =  fopenC ’ error_data . txt ’ , ’ a ’ ) ; 

[“ , ind_imag0]  =  max (imag (numO) ) ; 
fprintf (fid , ’ %s  %s ’ , *  Real ’ , ’ Imag ’ ) ; 

fprintf  (fid  ,  ’  \n\r%16)  .8f  %10.8f*,real  (num®  (ind_imag®  )  )  ,  imag  ( 
numO(ind_imagO))) ; 

end 


[val2 ]  =  site_contact_vec (am , im , em , Om , om , numO , long_site , GMST (1) , 
TvecB (end) , t_step , lat_site , Rsite , el_val)  ; 


if  isempty (val2 )  ==  ® 

J  =  Inf; 

else 

3  =  DV  +  DV2 ; 

end 

end 

end 

FI. 1.6  Convert  RSW  Coordinates  to  Cylinder  Frame 

function  [deputy_pos , rel_pos]  =  box2cw (chief_pos , chief_vel ,box_vec , alpha 
, beta) 

%this  function  converts  from  safe  zone  coordinate  frame  to  the  cw 
%coordinate  frame 

%INPUTS 

%  box_vec  -  (3x1)  vector  defining  a  coordinate  in  the  box  frame  (km) 

%  alpha  -  rotation  angle  between  fundamental  plane  in  box  frame  and 
%  fundamental  plane  in  cw  frame  (rad) 

%  beta  -  rotation  angle  between  principal  axis  in  cw  frame  and  box  frame 
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rel_pos  =  rotSmat (-beta) *rot2mat (alpha) *box_vec : 


xhat  =  chief_pos/norin(chief_pos)  ; 
yhat  =  chief_vel/norm(chief_vel) ; 
hvec  =  cross (chief_pos , chief_vel) ; 
zhat  =  hvec/norm(hvec) ; 

~ , ic , Oc , ~ , nucQ]  =  RV2C0E (chief_pos , chief_vel) ; 

deputy_pos  =  chie£_pos  +  rotSmat (-Oc) *rotlmat (-ic) *rot3mat (-nuc8) * 
rel_pos  ; 

F.1.1. 7  Determine  Initial  and  Final  Velocities  for  Inspection  Segment 

function  [v8_tilde , v£_tilde]  =  relative_velocity (T , P , pos8 , posf) 
%relative  velocity  returns  the  required  initial  and  final  relative 
%velocities  to  get  the  deputy  satellite  from  the  relative  position  posQ 
%to  the  relative  position  posf  (relative  to  the  chief  satellite)  in  T/P 
time  units 


%INPUTS 


%  1  -  actual  time  of  trajectory  (sec) 

%  P  =  period  of  the  chief  satellite  (sec) 

%  pos®  =  relative  position  vector  (3x1)  of  lobe  entry  point  (km) 
%  posf  =  relative  position  vector  (3x1)  of  lobe  exit  point  (km) 


%0UTPUTS 
%  v®_tilde 
%  vf_tilde 


time 

time 


scaled  relative  velocity  vector 
scaled  relative  velocity  vector 


(3x1)  at  pos® 
(3x1)  at  posf 


%% 
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X®  =  pos®  (1)  ; 
y®  =  pos®  (2)  ; 
z®  =  pos®  (3)  ; 
x£  =  pos£( 1) ; 
y£  =  pos£(2) ; 
z£  =  pos£(3) ; 

T_tilde  =  T/P; 

S_tilde  =  sin (2 ''pi *T_tilde)  ; 
C_tilde  =  cos  (2''pi*T_tilde)  ; 
delta_y  =  y£  -  y® ; 


%Initialize  A  Matrices  to  determine  relative  velocities  at  entry  and 
% arrival  locations 
A®  =  zeros  (3,5); 

A£  =  zeros  (3,5); 


%A  Matrix  at  lobe  entry 

A®(1,1)  =  (6*pi ''T_tilde''C_tilde  -  4*S_tilde) /(8  -  6''pi*T_tilde*S_tilde  - 
8*C_tilde) ; 

A®  (1,3)  =  (4*S_tilde  -  6*pi''T_tilde)/(8  -  6''pi ''T_tilde*S_tilde  -  8* 
C_tilde) ; 

A®(1,5)  =  (2"C_tilde  -  2)/(8  -  6*pi "T_tilde*S_tilde  -  8*C_tilde) ; 

A®(2,1)  =  (-14  +  12''pi*T_tilde*S_tilde  +  14*C_tilde) /(8  -  6*pi*T_tilde'' 
S_tilde  -  8''C_tilde)  ; 

A®(2,3)  =  (2  -  2*C_tilde)/(8  -  6*pi "T_tilde*S_tilde  -  8*C_tilde) ; 

A®(2,5)  =  (S_tilde)/(8  -  6*pi*T_tilde''S_tilde  -  8*C_tilde); 

A®(3,2)  =  -C_tilde/S_tilde ; 

A®(3,4)  =  1/S_tilde; 

A®  =  2*pi*A®; 
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%A  Matrix  at  lobe  exit 


A£(l,l)  =  (-4*S_tilde  +  6*pi*T_tilde)/(8  -  6*pi*T_tilde*S_tilde  -  8* 
C_tilde) ; 

A£(l,3)  =  C4*S_tilde  -  6*pi*T_tilde*C_tilde) /(8  -  6*pi*T_tilde*S_tilde 
8*C_tilde) ; 

A£(l,5)  =  (2 -2*C_tilde) /C8  -  6*pi*T_tilde*S_tilde  -  8*C_tilde) ; 

A£(2,l)  =  (2  -  2*C_tilde)/(8  -  6*pi*T_tilde*S_tilde  -  8*C_tilde) ; 
A£(2,3)  =  (-14  +  12*pi*T_tilde*S_tilde  +  14*C_tilde) /(8  -  6*pi*T_tilde* 
S_tilde  -  8*C_tilde) ; 

A£(2,5)  =  S_tilde/(8  -  6*pi*T_tilde*S_tilde  -  8*C_tilde) ; 

A£(3,2)  =  -1/S_tilde; 

A£(3,4)  =  C_tilde/S_tilde ; 

A£  =  2*pi*A£; 

state_vec  =  [xO ; zO ; x£ ; z£ ; delta_y ] ; 

vO_tilde  =  A®*state_vec ; 
v£_tilde  =  A£* state_vec ; 

El. 1.8  Propagate  Motion  of  Chaser  For  Relative  Inspection  Phase 

£unction  [rel_pos]  =  CW_Motion3 (deputy_relO , v8_tilde , Tvec , P) 

%CW  Motion  determines  the  position  o£  a  deputy  satellite  in  a  relative 
%£rame  cenetred  on  a  chie£  satellite  given  an  initial  relative  position 
%velocity ,  the  actual  time  o£  the  motion  and  period  o£  the  chie£ 
satellite 

%INPUTS 

%  deputy_rel8  =  position  vector  (3x1)  o£  deputy  satellite  (km) 

%  v8_tilde  =  velocity  vector  (3x1)  o£  deputy  satellite 
%  1  -  actual  time  o£  motion  (sec) 
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%  P  -  period  o£  chief  satellite  (sec) 


%0UTPUTS 

%  rel_pos  =  relative  position  vector  (Sxlength (Tvec) )  of  deputy  (km) 
%  T_out  =  Amount  of  time  spent  outside  of  ellipse  (sec/P) 

%% 


Tvec  =  Tvec/P; 


Tmat 1(1, 
Tmat 1 (2 , 
Tmatl (3 , 


)  =  sin(2*pi*Tvec) ; 
)  =  cos (2*pi *Tvec) ; 
)  =  1; 


Tmat2  ( 1  , 
Tmat2 (2 , 
Tmat2 (3 , 
Tmat2 (3  , 


)  =  sin (2*pi *Tvec) ; 

)  =  cos (2*pi*Tvec) ; 

)  =  (-  l/pi*v0_tilde (1)  +  deputy_relO (2) ) . *Tmat 1 (3 , : ) ; 

)  =  Tmat2(3,:)  -  (3*v0_tilde  (2)  +  12*pi ''deputy_rel®  (1)  )  *Tvec  ; 


xvals  =  [  1/(2 ''pi)  *  vQ_tilde  (1)  ,  -  (1/ pi ''v0_tilde  (2)  +  3 *  deputy _rel0  ( 1)  )  ,1/ 
pi ''v0_tilde  (2)  +  4*  deputy_relQ  (1)  ]  ; 
yvals  =  [(2/pi*vQ_tilde  (2)  +  6''deputy_rel0  (1)  )  ,  1/pi  *v0_tilde  (1)  ,1]  ; 
zvals  =  [l/(2*pi)*v0_tilde (3) , deputy_rel0 (3) ,0] ; 


xpos  =  xvals''Tmatl  ; 
ypos  =  yvals ''Tmat2  ; 
zpos  =  zvals''Tmatl  ; 


rel_pos(l,:)  =  xpos; 
rel_pos(2,:)  =  ypos; 
rel_pos(3,:)  =  zpos; 
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F.1.1.9  Determine  if  Chaser  Exits  Cylinder 

function  [T_out , T_in , pos_out , pos_in , time_out]  =  out_of_cylinder (rel_pos , 
Tvec  ,  xmin  ,  r_cyl) 

%%  Determine  if  satellite  leaves  safe  zone 
time_out  =  zeros (length(Tvec) , 1) ; 

r_vec  =  sqrt  (rel_pos  (2  ,  :  )  .  ■'2  +  rel_pos  (3  ,  :  )  . " 2)  ; 

%set  of  indices  where  deputy  is  less  than  xmin 
ind_ex_xmin  =  find(rel_pos (1 , : )  <  xmin); 
time_out (ind_ex_xmin( : ) )  =  1; 

%set  of  indices  where  deputy  is  greater  than  ymax 
ind_ex_cyl  =  find (r_vec ( : )  >  r_cyl) ; 
time_out (ind_ex_cyl C : ) )  =  1; 

ind_out  =  f ind (time_out  >  Q) ; 
ind_in  =  findCtime_out  ==  Q) ; 

pos_out  =  rel_pos ( : , ind_out ( : ) ) ; 
pos_in  =  rel_pos ( : , ind_in ( : ) ) ; 

T_out  =  length (ind_out) /length (time_out) *Tvec (end) ; 

T_in  =  length(ind_in)/length(time_out)*TvecCend) ; 

F.  1.1. 10  Determine  Maneuver  Path  is  in  Sight  of  Ground  Site 

function  [val , rho_sez]  =  site_contact_vec (a , inc , ecc , Omega , omega , nuO , 
lambda® , GMST8 , tmax , tstep , lat_site , rgs , el_val) 


%INPUTS 

%  3l  -  satellite  semimajor  axis  (km) 
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%  inc  =  satellite  inclination  (rad) 

%  ecc  =  satellite  eccentricity 
%  Omega  =  satellite  RAAN  (rad) 

%  omega  =  satellite  argument  of  perigee  (rad) 

%  nuO  =  initial  true  anomaly  (rad) 

%  lambdaO  =  initial  GMST  of  ground  site 
%  tmax  =  maximum  scenario  time  (sec) 

%  tstep  =  time  step  (sec) 

%0UTPUTS 

%  C_times  =  times  satellite  is  in  contact  with  the  ground  site 
%  C_ind  =  indices  of  satellite  contat  times 
%  rijk  =  position  vectors  of  satellite  at  discretized  times 
%  vijk  =  velocity  vectors  of  satellite  at  discretized  times 
%  rgs  =  position  vectors  of  the  ground  site  at  discretized  times 
%  rho_sez  =  vector  from  ground  site  to  satellite  in  SEZ  coordinates 
%  rho_RIC  =  vector  from  ground  site  to  satellite  in  RIC  coordinates 
% 


tvec  =  (0 : tstep : tmax) * ; 

%  determine  true  anomaly  of  spacecraft  at  each  time  step 
[nu_vec]  =  nuf_from_T0F_vec (nuO , tvec , a , ecc) ; 

if  ecc  ==  1 
keyboard 

end 

%determine  inertial  position  and  velocity  vectors  at  each  tiem  step 
[rijk]  =  C0E2RV_vec (a , ecc , inc , Omega , omega ,  nu_vec)  ; 
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if  size(rijk)  ~=  sizeCrgs) 
keyboard 

end 

wgs84data 

global  OmegaEarth 

long_site  =  lambda®  +  GMSTO  +  OmegaEarth*tvec ; 

%vector  from  ground  site  to  satellite 
rho_ijk  =  rijk  -  rgs ; 

%transform  into  sez  coordinates 
temp  =  zeros (3 , length (tvec) ) ; 

temp(l,:)  =  cos (long_site ’ ) . *rho_i jk (1 ,  : )  +  sin(long_site ’ ) . *rho_i jk 
(2,:); 

temp(2,:)  =  -sin(long_site ’ ) . *rho_i jk (1 , : )  +  cos (long_site ’ ) . *rho_i jk 
(2,:); 

temp (3,:)  =  rho_i jk  (3  ,  :  )  ; 

rho_sez  =  zeros (3 , lengthCtvec) ) ; 
rho_mag  =  zeros (1 , length(tvec) ) ; 

rho_sez(l,:)  =  cos(pi/2  -  lat_site) *temp ( 1 , : )  -  sin(pi/2  -  lat_site)* 
temp (3  ,  :  )  ; 

rho_sez(2,:)  =  tempC2,:); 

rho_sez(3,:)  =  sin(pi/2  -  lat_site) *temp  ( 1 ,  : )  +  cosCpi/2  -  lat_site)* 
temp  (3  ,  :  )  ; 

rho_mag  =  sqrt (rho_sez  (1 ,  :  )  .  “ 2  +  rho_sez (2 , : )  .  "2  +  rho_sez (3 , : )  . " 2)  ; 
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val  =  findCasind Crho_sez  (3  ,  :  )  . /rho_mag)  >  el_val); 

F.l.l  PSO  Driver  Script 

%% 


%maximum  number  of  entries  into  exclusion  zone  before  maneuver  is 

%required 

close  all 

%  clear  all 

clc 

el_val_pass  =  Q; 
el_val_shadow  =  1; 

GMST0  =  0; 
lat_site  =  pi/4; 
long_site  =  0; 
t®  =  0; 

tf_max  =  36*3600; 
tstep  =  1; 
r_cyl  =  1; 
xmin  =  1; 
xmax  =  3 ; 

%%  Determine  Chief  Satellite  Entry/Exit  over  Exclusion  Zone 

%Initial  COEs  of  chief  satellite 
a_chief_vec  =  [26581.76  7378  6878]; 
e_chief  =  0; 
i_chief  =  55*pi/180; 

0_chief  =  0; 
o_chief  =  0; 

%  nu_chief_vec  =  0; 
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nu_chie£  =  0; 


chie£_params  =  [e_chie£ ; i_chie£ ; 0_chie£ ; o_chie£ ; nu_chie£] ; 

%Initial  COEs  o£  deputy  satellite 

a_dep  =  6578; 

e_dep  =  0; 

i_dep  =  55*pi/180; 

0_dep  =  0; 
o_dep  =  0; 
nu_dep0  =  0; 

dep_parains  =  [a_dep  ;  e_dep  ;  i_dep  ;  0_dep  ;  o_dep]  ; 

a_GEO  =  42164. 14; 
e_GEO  =  0; 
i_GEO  =  0; 

0_GE0  =  0; 
o_GEO  =  0; 

GEO_parains  =  [a_GE0  ;  e_GEO  ;  i_GEO  ;  0_GE0  ;  o_GE0]  ; 

swarm  =  15; 
iter  =  10; 
prec  =  [0 ; 0 ; 6] ; 

%i£  kin£  “=  0,  inner  loop  PSO  assigned  ini£inite  cost  to  categorical 
%variables  i£  inner  loop  PSO  has  in£inite  cost  a£ter  kin£  iterations 
kin£  =  50; 

load( ’ C : \Users\Dan  Showalter\Documents\MATLAB\PSO\Relative  Motion\ 
Article_Data\Rev2\ThreePassEnumData ’ ) ; 

£or  aa  =  1:3 
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C_times_c  =  ThreePassEnumData (aa) . times ; 
[max_ind(aa)  , "]  =  size (C_times_c) ; 


end 

maxP  =  max (max_ind) ; 

for  bb  =  16:30 

if  bb  ==  1  II  bb  ==  0 

total_repPSOinf  =  zeros (length (a_chief_vec) ,maxP) ; 
save (’C:\Users\Dan  Showalter \Documents\MATLAB\PSO\Relati ve 
Motion\Article_Data\Rev2\total_repPS0inf . mat ’ , * 
total_repPSOinf ’ ) ; 

end 


[ JGmin  , Jpbest , gbest_tot , x , k , k_tot , JG , rep_mat , pop_mat]  = 

PSO_MULTISAT_COOP_WRAPPER(2 , [1  length (a_chief_vec) ; 1  maxP] ,prec , 
iter  ,  swarm  ,  GMST0  ,  lat_site  ,  long_site  ,  tstep  ,  a_chief_vec  ,  dep_params 
, GE0_params , xmin , xmax , r_cyl  ,  .  .  . 
el_val_shadow , max_ind , ThreePassEnumData , kinf ) ; 


tend  =  toc(tstart); 

load ( ’ C : \Users\Dan  Showalter\Documents\MATLAB\PSO\Relative  Motion\ 
Artie le_Data\Rev2\ to tal_repPS0inf ’ ) ; 
fid  =  fopen(’C: \Users\Dan  Showalter\Documents\MATLAB\PSO\Relative 
Motion\Article_Data\Rev2\ThreePassHybridPS0DataInf . txt ’ , ’ a ’ ) ; 
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fprintf (fid , ’%i\t\t%2i\t\t%5i\t\t%3 . 2 £\t\t%5i\t\t%4 . 3f\t\t%4 . 3f\t\t 


%5i\t%3.2f\t\t%5i\t\t%6. 5£\t\t%2i\t\t%6.2f\r\n’  ,  . . . 
bb , gbest_tot (1) ,gbest_tot(2) ,gbest_tot(3) ,gbest_tot(4) ,gbest_tot 
(5) , gbest_tot (6) , gbest_tot (7) , gbest_tot (8) , gbest_tot  (9)  , 

JGmin , k_tot , tend) ; 

£or  ee  =  1 : lengthCa_chie£_vec) 

£or  ££  =  l:maxP 

3rep  =  rep_mat (ee , ££) ; 

3tot  =  total_repPSOin£(ee , ££) ; 
i£  Jrep  <  Jtot  | |  Jtot  ==  Q 
i£  Jtot  ~=  In£ 

total_repPSOin£(ee , ££)  =  Jrep; 
end 

end 

end 

end 


save(’C:\Users\Dan  Showalter\Documents\MATLAB\PSO\Relative  Motion\ 
Article_Data\Rev2\total_repPS0in£. mat ’ , ’total _repPS0in£’) ; 
clear  total_repPSOin£ 

end 

F.  1.2.1  Outer  Loop  PSO 

£unction  [JGmin ,Jpbest ,gbest_tot ,x,k, k_tot , JG , rep_mat , pop_mat ]  = 

PS0_MULTISAT_C00P_WRAPPER (n,limits,prec,iter, swarm ,GMSTQ,lat_site, 
long_site , t_step , a_chie£_vec , dep_params , GE0_params , xmin , xmax , r_cyl 

el_val_shadow , max_ind , DataStruct , kin£) 
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%Author :  Dan  Showalter  23  Sep  2813 

%Purpose :  PSO  inside  of  a  PSO 

%generic  PSO  inputs 
%  n:  #  of  design  variables 

%  limits:  bounds  on  design  variables  (n  x  2  vector)  with  first  element 
%  in  row  n  being  lower  bound  for  element  n  and  2nd  element  in  row 

n  being 

%  upper  bound  for  element  n 

%  iter:  number  of  iterations 

%  swarm:  swarm  size 

%  prec :  defines  the  number  of  decimal  places  to  keep  for  each  design 
%  variable  and  the  cost  function  evalution  size:  (n+1,1) 


%Problem  specific  PSO  inputs 

%  GMST8  =  initial  Greenwich  mean  standard  time  (rad) 

%  lat_site  =  ground  site  latitude 
%  long_site  =  ground  site  longitude 

%  chief_params  =  vector  (1x5)  of  fixed  orbital  elements  of  chief 
satellite 

%  nu_chief_vec  =  vector  of  potential  initial  true  anomalies  for  chief 
%  dep_params  =  vector  (1x6)  of  initial  orbital  elements  of  deputy 
satellite 

%  GE0_params  =  vector  of  (1x5)  of  fixed  orbital  elements  of  GEO 
satellite 

%  Coast_time_d  =  matrix  (2xm)  of  allowed  maneuver  windows 
%  (l,m)  =  start  time  of  mth  window 

%  (2,m)  =  end  time  of  mth  window 

%  tf_max  =  maximum  scenario  time  (sec) 

%  tstep  =  discrete  time  step  (sec) 

%  xmin  =  minimum  x  distance  from  deputy  to  satellite  in  CW  frame  (km) 
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%  xmax  =  maximum  x  distance  from  deputy  to  satellite  in  CW  frame  (km) 
%  Pc  =  period  of  chief  satellite  (sec) 

%  r_cyl  =  cylinder  radius  (km) 

% 


%% 


[N,“]  =  size (limits) ; 

Him  =  limits  (  :  ,  1)  I 
ulim  =  limits ( : , 2) ; 

if  N“=n 

fprintf (’ Error !  limits  size  does  not  match  number  of  variables’) 
stop 

end 

gbest  =  zeros(n,l); 

X  =  zeros (n , swarm) ; 

V  =  zeros (n , swarm) ; 
pbest  =  zeros (n , swarm) ; 

Jpbest  =  zeros (swarm  ,  1)  ; 
x_inside  =  zeros (7 , swarm) ; 
d  =  (ulim  -  Him)  ; 

JG  =  zeros  (iter  ,  1)  ; 

J  =  zeros (swarm  ,  1)  ; 

rep_mat  =  zeros (ulim( 1) , ulim (2) ) ; 

pop_mat  =  struct ( ’ pop ’ , zeros (n , swarm) , ’ J ’ , zeros (swarm , 1) ) ; 

Him2  =  ones  (n  ,  swarm)  ; 
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ulim2  =  ones (n , swarm) ; 

%  CoreNum  =  12; 

%  if  (matlabpool ( ’ size ’ ) ) <=0 
%  matlabpool ( ’ open ’ , ’ local ’ , CoreNum) ; 

%  else 

%  disp (’ Parallel  Computing  Enabled’) 

%  end 

parfor  aa  =  l:n 

llim2 (aa  ,  : )  =  llim(aa) * llim2 (aa , : ) ; 
ulim2 (aa , : )  =  ulim(aa) *ulim2 (aa , : ) ; 

end 

d2  =  ulim2  -  llim2 ; 


xrep (ulim( 1) , max_ind)  =  struct ( ’ xinsidevals ’ , zeros  (1,7)); 
%loop  until  maximum  iteration  have  been  met 
for  k  =  1 : iter 

t_inside  =  tic ; 

%create  particles  dictated  by  swarm  size  input 


%  if  this  is  the  first  iteration 
if  k  ==  1 

X  =  unidrnd (ulim2 ) ; 

V  =  random ( ’ unif ’ , -d2 , d2 , [n , swarm] ) ; 

%if  this  is  after  the  first  iteration,  update  velocity  and 
position 

%of  each  particle  in  the  swarm 

else 
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for  h  =  1 : swarm 


cl  =  2.09; 
c2  =  2.09; 
phi  =  cl+c2 ; 

ci  =  2/abs(2-phi  -  sqrt(phi''2  -  4*phi)); 

cc  =  cl*random( ’ unif *  ,  0 , 1) ; 
cs  =  c2*random( ’unif*  ,0 , 1) ; 


vdum  =  v( : , h) ; 

%update  velocity 

%  vdum  =  ci*(vdum  +  cc* (pbest ( : , h)  -  x(:,h))  + 

cs*(gbest  -  x(: ,h))) ; 

vdum  =  ci*(vdum  +  cc* (pbest (:, h)  -  x(:,h))  +  cs*(gbest  -  x 
(: ,h))) ; 

%check  to  make  sure  velocity  doesn’t  exceed  max  velocity  for 
each 
%variable 
for  w  =  l:n 

%if  the  variable  velocity  is  less  than  the  min,  set  it 
to  the  min 
if  vdum(w)  <  -d(w) 
vdum(w)  =  -d(w) ; 

%if  the  variable  velocity  is  more  than  the  max,  set 
it  to  the  max 
elseif  vdumCw)  >  d(w) ; 
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vdumCw)  =  d(w) ; 


end 

end 

V ( : , h)  =  vdum ; 

%update  position 
xdum  =  x(:,h)  +  v(:,h); 

for  r  =  l:n 

%i£  particle  has  passed  lower  limit 
if  xdum(r)  <  llimCr) 
xdumCr)  =  llim(r) ; 

elseif  xdum(r)  >  ulim(r) 
xdum(r)  =  ulim(r) ; 

end 

X  C :  , h)  =  xdum ; 


end 


end 


end 

%  round  variables  to  get  finite  precision 
for  aa  =  l:n 

X  (aa  ,  :  )  =  round  (x  (aa  ,  :)*10''(prec(aa)))/lQ''precCaa)  ; 
v(aa  ,  :  )  =  round  Cv(aa  ,  :)*10''(prec(aa)))/lQ''precCaa)  ; 


end 
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pop_mat (k) . pop  =  x; 


%% 


'Cost  Function 


for  m  =  1 : swarm 

MU  =  398600.5; 


%  *  *  *  *  *  *  **********  ^  Q  5  ^  function  evaluation  here 


opt_vars  =  X ( : , m) ; 

%  variable  definitions 

satellite  =  opt_vars(l); 
min_ind  =  opt_vars(2); 

C_times_c  =  DataStruct (satellite) . times ; 
C_ind_c  =  DataStruct (satellite) . ind ; 

Ri jk_c  =  DataStruct (satellite) .Rc; 

Vi jk_c  =  DataStruct (satellite) .Vc; 
rho_vec_cw_c  =  DataStruct (satellite) . rho_c ; 
Tvec_c  =  DataStruct (satellite) .Tc; 
max_ind  =  DataStruct (satellite) .max_ind; 

if  min_ind  >  max_ind 
J (m)  =  Inf ; 

else 

if  rep_mat (satellite , min_ind)  ==  Inf 
J (m)  =  Inf ; 

if  rep_mat (satellite , min_ind)  "=  0 

J (m)  =  rep_mat (satellite , min_ind) ; 
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x_inside  C : , m)  =  xrep (satellite , min_ind) . xinsidevals ; 


else 


%Period  of  Chief  satellite’s  orbit 

Pc  =  2*pi ''sqrt  (a_chief_vec  (satellite)  "3/ MU)  ; 


t_enter  =  C_times_c (min_ind , 1) ; 
t_exit  =  C_times_c (min_ind , 2) ; 
t_zone  =  t_exit  -  t_enter; 

%determine  indices  of  minimum  duration  contact 
C_ind_contact  =  C_ind_c (min_ind , : ) ; 

%find  unit  vector  pointing  towards  the  deputy  that  puts 
chief  between 
%ground  site  and  deputy 

rho_unit_cw  =  rho_vec_cw_c ( : , C_ind_contact (1) : 
C_ind_contact (2) ) ; 

%determine  alpha  and  beta  angles  during  contact  times 
[alphavec ,betavec]  =  alphabeta (rho_unit_cw) ; 

%Vector  of  times  for  propogation 

T_prop  =  Tvec_c (C_ind_contact ( 1) : C_ind_contact (2) )  - 
Tvec_c (C_ind_contact (1) ) *ones (length (Tvec_c ( 
C_ind_contact (1) : C_ind_contact (2) )) ,1) ; 

%Determine  position/velocity  vectors  of  chief  satellite 
upon  intial/final 
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%contact 


chie£_pos0  =  Ri jk_c ( : , C_ind_c (min_ind , 1) ) ; 
chie£_vel0  =  Vi jk_c ( : , C_ind_c (min_ind , 1) ) ; 
chie£_pos£  =  Ri jk_c ( : , C_ind_c (min_ind , 2) ) ; 
chie£_vel£  =  Vi jk_c ( : , C_ind_c (min_ind , 2) ) ; 

i£  min_ind  <  max_ind 

max_coast£  =  C_times_c (min_ind+l , 1)  -  C_times_c( 
min_ind  ,  2) ; 

else 

max_coast£  =  DataStruct (satellite) . max_coast£ ; 

end 

%tirae  variables  have  precision  to  .1  second.  Others 
have 

%precision  to  0.001  units  (km, rad) 
prec2  =  [2 ; 0 ; 3 ; 3 ; 0 : 2 ; 0 ; 6]  : 

x( : ,m) ; 

[J (m) , ~ , x_inside_dum , ~ , k_inside  , "]  = 

PS0_REL_SHAD0W_DV4in£(7 , [0  2*pi ; 1  C_times_c (min_ind 
,l);xmin  xmax ; xmin  xmax ; 1  max_coast£;0  2*pi  ;  1 
16*3600] , prec2 , 500 , 300 , chie£_pos0 , chie£_vel0 , 
chie£_pos£ , . . . 

chie£_vel£ , dep_params , GEO_params , alphavec , betavec , 
t_zone  ,  Pc  ,  t_enter  ,  t_exit ,  r_cyl  ,  T_prop  ,  GMST0  , 
lat_site , long_site , t_step , el_val_shadow , kin£) ; 
i£  k  ==  1  II  rep_mat (satellite , min_ind)  ==  0 
rep_mat (satellite , min_ind)  =  1 (m) ; 

xrep (satellite , min_ind) . xinsidevals  =  x_inside_dum ; 

else 
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if  J  (m)  <  rep_inat  (satellite  ,  min_ind) 
rep_mat (satellite, mi n_ind)  =  J (m) ; 

end 

end 

J  (m)  ; 

x_inside ( : , m)  =  x_inside_dum ; 
out_loop  =  m; 
if  k  ==  1 

k_tot  =  k_inside; 

else 

k_tot  =  k_inside  +  k_tot; 

end 

end 

end 

end 


[mini , ind_minJ ]  =  min(l); 
x_inside ( : , ind_minJ ) 

*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *******  c  o  n  s  t  r  a i n t  Equations 


%% 


%% 


if  k  ==  1 


Jpbest (1 ; swarm)  =  1(1: swarm); 
pbest (:, 1 : swarm)  =  x (:, 1 : swarm) ; 
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[Jgbest,IND]  =  min( Jpbest ( : ) ) ; 


gbest  (:)  =  xC:  , IND) ; 
g_inside_best  =  x_inside ( : , IND) ; 


else 

parfor  h=l: swarm 

i£  1(h)  <  Jpbest(h) 

Jpbest (h)  =  J (h) ; 
pbest(: ,h)  =  x(: ,h) ; 

end 

end 

[Jit_min ,min_ind]  =  minCJpbest); 
if  Jit_min  <  Jgbest 

Jgbest  =  Jpbest (min_ind) ; 
gbest(:)  =  x ( : , min_ind) ; 
g_inside_best  =  x_inside(: ,min_ind) ; 


end 

end 


%round  cost  to  nearest  precision  required 
J  =  round(J*lO''prec(n+l))/10"prec(n+l)  ; 
pop_mat  (k) . J  =  J ; 

JG(k)  =  Jgbest ; 

JGmin  =  Jgbest ; 
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iter_complete  =  k 
iter_time  =  toe (t_inside) 
format  long  g 
gbest 

g_inside_best 

JGmin 

end 

gbest_tot (1 : n)  =  gbest; 

gbest_tot (n+1 : n+ length ( g_insi de_be st ) )  =  g_inside_best ; 

F.1.2.2  Inner  Loop  PSO  Algorithm  with  Infeasible  Cutoff 

function  [JGmin , Jpbest , gbest , x , k , JG , ex_f lag]  =  PS0_REL_SHAD0W_DV4inf (n , 
limits , prec , iter , swarm , chief_pos® , chief_vel® , chief_posf , chief_velf , 
dep_params  ,  GEO_params  ,  alphavec  ,  betavec  ,  t_zone  ,  Pc  ,  T_enter  ,  T_exit  ,  .  .  . 

r_cyl , T_prop 
,GMST0 , 
lat_site 

j 

long_site 
, t_step  , 
el_val  , 
kin£) 


%Author :  Dan  Showalter  18  Oct  2812 


%Purpose :  Utilize  PSO  to  solve  multi -orbit  sinegle  burn  maneuver  problem 


%generic  PSO  variable 
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% 

% 

% 


% 

% 

% 

% 

% 


n:  #  of  design  variables 
limits:  bounds  on  design  variables 
in  row  n  being  lower  bound  for 
n  being 

upper  bound  for  element  n 
iter:  number  of  iterations 
swarm:  swarm  size 

prec :  defines  the  number  of  decimal 
variable  and  the  cost  function 


(n  X  2  vector)  with  first  element 
element  n  and  2nd  element  in  row 


places  to  keep  for  each  design 
evalution  size:  Cn+1,1) 


%Problem  specific  PSO  variables 


%Specific  Problem  Variables 


%% 


[N,“]  =  size (limits) ; 


Him  = 

limits ( : 

,1) 

ulim  = 

limits ( : 

,2) 

if  N“=n 

fprintf C ’ Error !  limits  size  does  not  match  number  of  variables’) 
stop 

end 
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gbest  =  zeros(n,l); 

X  =  zeros (n , swarm) ; 

V  =  zeros (n , swarm) ; 
pbest  =  zeros (n , swarm) ; 
Jpbest  =  zeros (swarm  ,  1)  ; 
d  =  (ulim  -  Him)  ; 

JG  =  zeros (iter  ,  1)  ; 

J  =  zeros (swarm , 1) ; 

llim2  =  ones (n , swarm) ; 
ulim2  =  ones (n , swarm) ; 

for  aa  =  l:n 


llim2 (aa , 

:) 

=  llim(aa) *llim2 (aa  , 

:) 

ulim2 (aa , 

:) 

=  ulim(aa) *ulim2 (aa  , 

:) 

end 

d2  =  ulim2  -  llim2 ; 

CoreNum  =  12 ; 

if  (matlabpool ( ’ size  * ) ) <=® 

matlabpool ( ’ open  * , ’local ’ , CoreNum) ; 

else 

disp (’ Parallel  Computing  Enabled ’ ) 

end 

tstart  =  tic; 

%loop  until  maximum  iteration  have  been  met 

for  k  =  1 : iter 

%create  particles  dictated  by  swarm  size  input 
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%  if  this  is  the  first  iteration 


if  k  ==  1 

rng ( ’ shuffle ’ ) ; 

X  =  randomC ’ unif llim2 , ulim2 , [n , swarm] ) ; 
V  =  random C ’ unif ’ , -d2 , d2 , [n , swarm] ) ; 


else 


%if  this  is  after  the  first  iteration,  update  velocity  and 
position 

%of  each  particle  in  the  swarm 

parfor  h  =  1 : swarm 
cl  =  2.09; 
c2  =  2.09; 
phi  =  cl+c2; 

ci  =  2/abs(2-phi  -  sqrt(phi''2  -  4*phi)); 
cc  =  cl*random( ’ unif ’  ,  0 , 1) ; 
cs  =  c2*random( ’unif ’  ,0 , 1) ; 


vdum  =  v( : , h) ; 

%update  velocity 
vdum  =  ci*(vdum  +  cc* (pbest ( : , h) 
(:  ,h)))  ; 


x(:,h))  +  cs*(gbest 


%check  to  make  sure  velocity  doesn’t  exceed  max  velocity  for 
each 
%variable 
for  w  =  l:n 
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%i£  the  variable  velocity  is  less  than  the  min,  set  it 
to  the  min 
if  vdum(w)  <  -d(w) 
vdumCw)  =  -d(w) ; 

%i£  the  variable  velocity  is  more  than  the  max,  set 
it  to  the  max 
elseif  vdum(w)  >  d(w) ; 
vdum(w)  =  d(w) ; 

end 

end 

V ( : , h)  =  vdum ; 

%update  position 
xdum  =  x(:,h)  +  v(:,h); 

for  r  =  l:n 

%i£  particle  has  passed  lower  limit 
if  xdum(r)  <  llim(r) 
xdum(r)  =  llim(r) ; 

elseif  xdum(r)  >  ulim(r) 
xdum(r)  =  ulim(r) ; 

end 

X ( : , h)  =  xdum ; 


end 


end 
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end 


%  round  variables  to  get  finite  precision 
parfor  aa  =  l:n 

x(aa,:)  =  round(x (aa , : ) *  10“ (prec (aa) ) ) /IQ" prec (aa)  ; 
v(aa,:)  =  round(v(aa ,:)* 10“ (prec (aa) )) /1Q“ prec (aa) ; 

end 


%% 


'Cost  Function 


xmin  =  limits (2,1); 


parfor  m  =  1 : swarm 

o/^  **************** function  evaluation  here 


opt_vars  =  X ( : , m) : 

[J(m)]  =  rel_shadow_cost_function2 (opt_vars , chief_pos0 , 

chief_velO , chief_posf , chief_velf , alphavec , betavec , t_zone , Pc , 
T_prop , xmin , r_cyl , dep_params , . . . 

GE0_params , T_enter , 
T_exit , GUSTO  , 
long_site  , 
lat_site , t_step  , 
el_val)  ; 


end 


0/^  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *******  c  o  n  s  t  r  a  i  n  t  Equations 
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%% 


%% 


%round  cost  to  nearest  precision  required 
J  =  roundC J *  IQ" prec (n+1) ) /lO" prec (n+1) ; 

if  k  ==  1 

count  =  Q; 

Jpbest (1 : swarm)  =  J(l: swarm); 
pbest  (  :  , 1 : swarm)  =  x ( :  , 1 : swarm) ; 

[Jgbest,IND]  =  min( Jpbest  (:)) ; 

gbest  (:)  =  x(:  , IND) ; 


else 


for  h=l : swarm 

if  J (h)  <  Jpbest(h) 


Jpbest(h)  = 

J(h)  ; 

pbest ( : , h)  = 

x(: ,h) : 

if  Jpbest(h) 

<  Jgbest 

Jgbest  = 

Jpbest (h) 

gbest ( : ) 

II 

><1 

end 

end 

end 
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end 


di££  =  zeros (swarm  ,  1)  ; 
par£or  y  =  1 : swarm 

di££(y)  =  Jgbest  -  JpbestCy); 

end 

indcount  =  £ind(abs(di££)<10''  (-prec  (n+1)  ) )  ; 


JG(k)  =  Jgbest ; 

JGmin  =  Jgbest ; 

i£  kin£  "=  0; 
i£  k  >  kin£ 

i£  Jgbest  ==  In£ 
break 

end 

end 

end 

i£  length(indcount)  ==  swarm 
ex_£lag  =  0; 
break 

end 

i£  k  >  1 
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if  JG(k) 


JG(k-l) 


count  =  count  +  1; 

else 

count  =  0; 

end 

end 

if  count  >  1000 
ex_flag  =  1; 
break 

end 

end 

if  k  ==  iter 

ex_flag  =  2; 

end 

FA.3  GA  Driver  Script 

clc 

close  all 

for  h  =1:10 


el_val_pass  =  0; 
el_val_shadow  =  1; 
GMSTO  =  0; 
lat_site  =  pi/4; 
long_site  =  0; 

to  =  0; 

tf_max  =  36*3600; 
tstep  =  1; 
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r_cyl  =  1; 


xmin  =  1 ; 
xmax  =  3 ; 

%%  Determine  Chief  Satellite  Entry/Exit  over  Exclusion  Zone 

%Initial  COEs  of  chief  satellite 
a_chief  =  [26581.76  7378  6878]; 
e_chief  =  0; 
i_chief  =  55*pi/180; 

0_chief  =  0; 
o_chief  =  0; 

%  nu_chief_vec  =  0; 

nu_chief_vec  =  [0  90  180  270]*pi/180; 

chief_params  =  [e_chief:i_chief;0_chief;o_chief; nu_chief_vec ( 1)  ]  ; 

%Initial  COEs  of  deputy  satellite 

a_dep  =  6578; 

e_dep  =  0; 

i_dep  =  55*pi/180; 

0_dep  =  0; 
o_dep  =  0; 
nu_dep0  =  0; 

dep_params  =  [a_dep ; e_dep ; i_dep ; 0_dep ; o_dep] ; 

a_GE0  =  42164. 14; 
e_GE0  =  0; 
i_GE0  =  0; 

0_GE0  =  0; 
o_GE0  =  0; 

GE0_params  =  [a_GE0 ; e_GE0 ; i_GE0 ; 0_GE0 ; o_GE0] ; 
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load ( ' C : \Users\Dan  Showalter\Documents\MATLAB\PSO\Relative  Motion\ 


Article_Data\Rev3\ThreeTarget\ThreePassEnumData ’ ) ; 

kin£  =  50; 

for  aa  =  1:3 

C_times_c  =  ThreePassEnumData (aa) . times ; 

[max_ind(aa) , "]  =  size (C_times_c) ; 
clear  C_times_c 

end 

maxP  =  max (max_ind) ; 

if  h  ==  1 

total_repGAinf  =  zeros (3 , maxP) ; 

save (’C:\Users\Dan  Showalter \Documents\MATLAB\PSO\Relati ve 
Motion\Article_Data\Rev3\ThreeTarget\total_repGAinf . mat ’ , * 
total_repGAinf * ) ; 

end 

Him  =  [1  1]  ; 

ulim  =  [length(a_chief)  maxP]; 

PopSize  =  15; 
ulim2  =  zeros (PopSize  ,  2)  ; 
ulim2(:,l)  =  ulimCl) ; 
ulim2(:,2)  =  ulim(2) ; 

EliteSize  =  1; 

rep_mat  =  zeros (length(a_chief) ,maxP) ; 
fid3  =  fopen ( ’ GA_Jmin . txt ’ , * w ’ ) ; 
fprintf Cfid3 , ’%f ’  ,  10000) ; 
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fclose  C£id3) ; 


£id4  =  £open ( ’ GA_iters . txt ’ , * w ’ ) ; 
£print£C£id4 ,  ’%i ’  ,0) ; 

£close  C£id4) ; 

£id5  =  £open(’ repository . txt  * ,  ’ w ’ ) ; 
£print£C£id5 ,  ’ %7 . 5£  %7 . 5 £  %7 . 5£ ’  , rep_mat ) ; 
£close  C£id5 ) ; 

tstart  =  tic; 


rng ( ’ shu££le ’ ) ; 

Popinit  =  unidrnd(ulim2) ; 

options  =  gaoptimset ( ’ InitialPopulation ’ , Popinit , ’ PopulationSize ’ , 
PopSize , ’UseParallel’ , ’ never  * , ’ CrossoverFraction ’  ,0.8,... 

’ StallGenLimit ’ ,9, ’Generation’ ,9, ’TolFun’ ,le-6, ’EliteCount’ , 
EliteSize , ’Display’ , ’ diagnose ’ , ’Vectorized’ , ’o££’) ; 

[gbest , J , ex£lag , output]  =  ga (@(x) GA_Hybrid_Cost_082014 (x , GMST0 , 

lat_site  ,  long_site  ,  tstep  ,  a_chie£  ,  dep_params  ,  GEO_params  ,  xmin  ,  xmax 
,r_cyl  ,  .  .  . 

el_val_shadow , ThreePassEnumData , rep_mat , max_ind , kinf ) 

>  2  ,[],[],[],[]  ,  Him  ,ulim  ,  []  ,  [1 ,  2]  ,  options)  ; 

fid  =  fopen ( ’ GA_intermediate_vals . txt  ’  ) ; 
x_inside  =  f scanf (fid 7) : 

J_inside  =  f scanf (fid %d 1) : 
k_tot  =  f scanf (fid %d 1) ; 
fclose (fid) : 
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£id_int  =  fopen ( *  GA_opt_int . txt ’ ) ; 
min_sat  =  fscanf C£id_int , ’ %i *  , 1) ; 
min_pass  =  £scan£ (£id_int , ’ %i ’ , 1) ; 

£close C£id_int) ; 

£id_ iters  =  £open ( *  GA_iters . txt ’ ) ; 
iters  =  £scan£(£id_iters , ’ %d * ) ; 

J 

J_inside 

tend  =  toc(tstart) 

load ( *  C : \Users\Dan  Showalter\Documents\MATLAB\PSO\Relative  Motion\ 
Article_Data\Rev3\ThreeTarget\total_repGA ’ ) ; 
load ( *  C : \Users\Dan  Showalter\Documents\MATLAB\PSO\Relative  Motion\ 
Article_Data\Rev3\ThreeTarget\rep_mat_out ’ ) ; 

£or  ee  =  1 : lengthCa_chie£) 

£or  ££  =  l:maxP 

Jrep  =  rep_mat_out (ee , ££) ; 

Jtot  =  total_repGAin£Cee , ££) ; 
i£  Jrep  <  Jtot  | |  Jtot  ==  0 
i£  Jtot  "=  In£ 

total_repGAin£(ee , ££)  =  Jrep; 

end 

end 

end 

end 

save ( *  C : \Users\Dan  Showalter\Documents\MATLAB\PSO\Relative  Motion\ 
Article_Data\Rev3\ThreeTarget\total_repGA . mat ’ , ’ total_repGA ’ ) ; 
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133  fid_fin  =  fopen  (  ’  C  : \Users\Dan  Showalter\Documents\MATLAB\PSO\ 

Relative  Motion\Article_Data\Rev3\ThreeTarget\ 
ThreePassHybridGAData . txt ’ , ’ a ’ ) ; 

134  fprintf  (fid_fin  ,  ’ \r\n%2 i\t  %2i\t  %2i\t  %4.3f\t  %6i\t  %4.3£\t  %4.3f\t 

%6i\t  %4.3f\t  %6i\t  %7.5£\t  %i\t  %i\t  %8 . 2 £ ’ , h , min_sat , inin_pass 
,x_inside(l) ,x_inside(2) ,x_inside(3) ,x_inside(4) ,x_inside(5)  ,  . . . 

135  x_inside  (6)  ,  x_inside  (7)  ,  3  ,  output .  generations  ,  iters  ,  tend)  ; 

136 

137  clear  all 

138 

139  end 

F.  1.3.1  GA  Cost  Function 

1  £unction  [1 , x_inside_dum , k_inside , rep_mat_out]  =  GA_Hybrid_Cost_062Q14 (x 

, GUSTO , lat_site , long_site , t_step , a_cbie£_vec , dep_params , GEO_params , 
xmin , xmax , r_cyl  ,  .  . . 

2  el_val_ shadow , DataStruct , rep_mat , max_ind , kin£) 

3 

4 

5  % 


6  %  Tbis  £unction  evaluates  tbe  cost  £or  tbe  MATLAB  genetic  algorithm 

routine 

7  %Inputs  : 

8  %  x:  2x1  vector  o£  design  variables 

9  %  xCl)  de£ines  the  satellite  that  will  be  shadowed 

10  %  xC2)  is  the  pass  o£  xCl)  or  the  speci£ied  ground  site  to 

accomplish 

11  %  the  shadow 

12  %0utputs: 
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%  Global  Variables 


% 


MU  =  3986Q0. 5; 

satellite  =  x(l)  ; 
min_ind  =  x (2)  ; 

[rows, cols]  =  size (rep_mat ) ; 

£id_rep  =  fopen ( ’ repository . txt  * ) ; 

rep_mat  =  fscan£(£id_rep , ’%g ’ ,  [rows  cols]); 

£close (£id_rep) ; 

i£  min_ind  >  max_ind(satellite) 

1  =  In£; 

rep_mat (satellite , min_ind)  =  J; 

£id_rep  =  £open ( *  repository . txt ’  ,  ’ w ’ ) ; 

%number  o£  elements  must  equal  number  o£  satellites 
£print£C£id_rep , * %g  %g  %g  ’,rep_mat); 

£close C£id_rep) ; 

else 

%  i£  rep_mat (satellite , min_ind)  ==  In£ 

%  1  =  In£; 

%  else 

i£  rep_mat (satellite , min_ind)  “=  0 
J  =  rep_mat (satellite , min_ind) ; 

else 
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C_times_c  =  DataStruct (satellite) . times ; 
C_ind_c  =  DataStruct (satellite) . ind ; 

Ri jk_c  =  DataStruct (satellite) .Rc; 

Vi jk_c  =  DataStruct (satellite) .Vc; 
rho_vec_cw_c  =  DataStruct (satellite) . rho_c ; 
Tvec_c  =  DataStruct (satellite) .Tc; 
max_ind  =  DataStruct (satellite) .max_ind; 

%Period  of  Chief  satellite’s  orbit 

Pc  =  2*pi*sqrt (a_chief_vec (satellite)" 3 /MU) ; 


t_enter  =  C_times_c (min_ind , 1) ; 
t_exit  =  C_times_c (min_ind , 2) ; 
t_zone  =  t_exit  -  t_enter; 

%determine  indices  of  minimum  duration  contact 
C_ind_contact  =  C_ind_c (min_ind , : ) ; 

%find  unit  vector  pointing  towards  the  deputy  that  puts  chief 
between 

%ground  site  and  deputy 

rho_unit_cw  =  rho_vec_cw_c ( : , C_ind_contact (1) : C_ind_contact (2) ) ; 

%determine  alpha  and  beta  angles  during  contact  times 
[alphavec ,betavec]  =  alphabeta (rho_unit_cw) ; 

%Vector  of  times  for  propogation 

T_prop  =  Tvec_c (C_ind_contact (1) : C_ind_contact  (2) )  -  Tvec_c( 
C_ind_contact ( 1) ) *ones (length (Tvec_c (C_ind_c on tact (1) : 

C_ind_ contact (2) ) ) ,1) ; 
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%Deterinine  position/velocity  vectors  of  chief  satellite  upon 


intial/final 

%contact 

chief_pos®  =  Rijk_c( 
chief_velQ  =  Vijk_c( 
chief_posf  =  Rijk_c( 
chief_velf  =  Vijk_c( 


,  C_ind_c  (inin_ind  ,  1)  ) 
,  C_ind_c  (inin_ind  ,  1)  ) 
,  C_ind_c  (inin_ind  ,  2)  ) 
, C_ind_c (min_ind , 2) ) 


if  min_ind  <  max_ind 

max_coastf  =  C_times_c (min_ind+l , 1)  -  C_times_c (min_ind , 2) ; 

else 

max_coastf  =  DataStruct (satellite) . max_coastf ; 

end 


%time  variables  have  precision  to  .1  second.  Others  have 
%precision  to  0.081  units  (km, rad) 
prec2  =  [2 ; 0 ; 3 ; 3 ; 0 ; 2 ; 0 ; 6] ; 

[J , ~ , x_inside_dum , ~ , k_inside  ,  "]  =  PS0_REL_SHAD0W_DV4inf  (7  ,  [8  2* 
pi  : 1  C_times_c (min_ind , 1) ; xmin  xmax ; xmin  xmax ; 1  max_coastf;0 
2*pi ; 1  16*3680] , prec2 , 588 , 388 , chief_pos8 , chief_vel8 , 
chief_posf , . . . 

chief_velf , dep_params , GEO_params , alphavec , betavec , t_zone , Pc , 
t_enter , t_exit , r_cyl , T_prop , GMST8 , lat_site , long_site , 
t_step , el_val_shadow , kinf ) ; 

%determine  lowest  cost  so  far 
fidl  =  fopen( ’ GA_Jmin . txt ’ )  ; 

Jmin  =  f scanf (fidl , ’ %f ’ ) ; 
fclose (fidl) ; 
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%Update  inside  loop  iterations 
fid4  =  fopenC * GA_iters . txt ’ ) ; 
iters  =  £scan£C£id4 , ’ %d * ) ; 
iters  =  iters  +  k_inside; 

£close (£id4) ; 

£id5  =  £openC * GA_iters . txt ’ , ’ w ’ ) ; 
£print£(£id5 ,’%i’, iters); 

£close (£id5) ; 


Jrep  =  rep_mat (satellite ,min_ind) ; 
i£  Jrep  ==  0  | |  J  <  Jrep; 

rep_mat (satellite , min_ind)  =  J; 

end 

%update  repository 

£id_rep  =  £open( ’ repository . txt ’ , ’ w ’ ) ; 

%number  o£  elements  must  equal  number  o£  satellites 
£print£(£id_rep , ’%g  %g  %g  ’,rep_mat); 

£close (£id_rep) ; 

%I£  current  cost  is  better  than  lowest  cost  so  £ar ,  update  inner 
loop 

%variables 
i£  J  <  Jmin 

£id3  =  £open( ’ GA_Jmin . txt ’ , ’ w ’ ) ; 

£print£ (£id3,’%g’,J); 

£close (£id3) ; 

£id6  =  £open( ’ GA_opt_int . txt ’ , *  w ’ ) ; 

£print£ (£id6 , ’ %i  %i' , satellite , min_ind) ; 

£close (£id6) ; 
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fid2=£open(’ GA_intermediate_vals . txt ’ , ’ w ’ ) ; 

fprintf (fid2 , ’%3 . 2£\t  %i\t  %4.3£\t  %4.3£\t  %i\t  %3.2£\t  %i\t 
%7 . 5£’ , x_inside_dum ( 1) , x_inside_dum (2) , x_inside_dum (3) , 
x_inside_dum (4) , x_inside_dum (5) , x_inside_dum (6) , 
x_inside_dum (7) ,3) ; 

£close (£id2 ) ; 


end 

end 

end 

£id7  =  £open( ’ GA_opt_int . txt  ’  ) ; 

min_sat  =  £scan£(£id7 , ’%i ’  ,  1) ; 

min_pass  =  £scan£(£id7 , ’ %i ’  ,  1) ; 

£close (£id7) ; 

rep_mat_out  =  rep_mat ; 

save(’C:\Users\Dan  Showalter\Docuraents\MATLAB\PSO\Relative  Motion\ 
Article_Data\Rev2\ThreeTarget\rep_mat_out . mat ’ , ’ rep_mat_out ’ ) ; 

E2  Fifteen  Target  GTMEI 

F.2.0.2  Large  Outer  Loop  PSO 

£unction  [ JGmin ,Jpbest ,gbest_tot ,x,k, k_tot , JG , rep_mat , pop_mat ]  = 
PS0_LARGE_MULTISAT_C00P_WRAPPER(n, limits ,prec , iter , swarm , GMSTQ , 
lat_site , long_site , t_step , a_chie£_vec , dep_params , GE0_params , xmin , 
xmax , r_cyl  ,  .  .  . 

el_val_ shadow , max_ind ,stall_lim,DataStruct ,kin£) 

%Author :  Dan  Showalter  23  Sep  2813 

%Purpose :  PSO  inside  o£  a  PSO 
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%generic  PSO  inputs 
%  n:  #  of  design  variables 

%  limits:  bounds  on  design  variables  (n  x  2  vector)  with  first  element 
%  in  row  n  being  lower  bound  for  element  n  and  2nd  element  in  row 

n  being 

%  upper  bound  for  element  n 

%  iter:  number  of  iterations 

%  swarm:  swarm  size 

%  prec :  defines  the  number  of  decimal  places  to  keep  for  each  design 
%  variable  and  the  cost  function  evalution  size:  Cn+1,1) 


%Problem  specific  PSO  inputs 

%  GMST8  =  initial  Greenwich  mean  standard  time  (rad) 

%  lat_site  =  ground  site  latitude 
%  long_site  =  ground  site  longitude 

%  chief_params  =  vector  (1x5)  of  fixed  orbital  elements  of  chief 
satellite 

%  nu_chief_vec  =  vector  of  potential  initial  true  anomalies  for  chief 
%  dep_params  =  vector  (1x6)  of  initial  orbital  elements  of  deputy 
satellite 

%  GE0_params  =  vector  of  (1x5)  of  fixed  orbital  elements  of  GEO 
satellite 

%  Coast_time_d  =  matrix  (2xm)  of  allowed  maneuver  windows 
%  (l.m)  =  start  time  of  mth  window 

%  (2,m)  =  end  time  of  mth  window 

%  tf_max  =  maximum  scenario  time  (sec) 

%  tstep  =  discrete  time  step  (sec) 

%  xmin  =  minimum  x  distance  from  deputy  to  satellite  in  CW  frame  (km) 

%  xmax  =  maximum  x  distance  from  deputy  to  satellite  in  CW  frame  (km) 

%  Pc  =  period  of  chief  satellite  (sec) 

%  r_cyl  =  cylinder  radius  (km) 
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% 


%% 

[N,“]  =  size (limits) ; 

Him  =  limits  (  :  ,  1)  I 
ulim  =  limits(:,2); 

i£  N“=n 

fprintfC ’ Error !  limits  size  does  not  match  number  of  variables’) 
stop 

end 

gbest  =  zerosCn,!); 

X  =  zeros (n , swarm) ; 

V  =  zeros (n , swarm) ; 
pbest  =  zeros (n , swarm) ; 

Jpbest  =  zeros (swarm  ,  1)  ; 
x_inside  =  zeros (7 , swarm) ; 
d  =  (ulim  -  Him)  ; 

JG  =  zeros  (iter  ,  1)  ; 

J  =  zeros (swarm  ,  1)  ; 

rep_mat  =  zeros (ulim( 1) , ulim(2) ) ; 

pop_mat  =  struct ( ’ pop ’ , zeros (n , swarm) , ’ J ’ , zeros (swarm ,1) j ’gbest ’ , zeros (n 

,1)); 

Him2  =  ones  (n ,  swarm)  ; 
ulim2  =  ones (n , swarm) ; 

%  CoreNum  =  12; 

%  if  (matlabpool ( ’ size ’ ) ) <=0 
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%  matlabpool ( ’ open ’ , ’ local ’ , CoreNum) ; 

%  else 

%  dispC ’ Parallel  Computing  Enabled’) 

%  end 


parfor  aa 

=  l:n 

llim2 

(aa  , 

:) 

=  llim(aa) *llim2 (aa  , 

:) 

ulim2 

(aa  , 

:) 

=  ulim(aa) *ulim2 (aa  , 

:) 

end 


d2  =  ulim2  -  llim2 ; 

tstart  =  tic; 

xrep (ulim( 1) , max_ind)  =  struct ( ’ xinsidevals ’ , zeros (1,7)); 

%loop  until  maximum  iteration  have  been  met 
for  k  =  1 : iter 

t_inside  =  tic ; 

%create  particles  dictated  by  swarm  size  input 

%  if  this  is  the  first  iteration 
if  k  ==  1 

X  =  unidrnd (ulim2 ) ; 

V  =  random C ’ unif ’ , -d2 , d2 , [n , swarm] ) ; 

%if  this  is  after  the  first  iteration,  update  velocity  and 
position 

%of  each  particle  in  the  swarm 

else 

for  h  =  1 : swarm 


444 


95 

96 

97 

98 

99 

100 

101 

102 

103 

104 

105 

106 

107 

108 

109 

110 

111 

112 

113 

114 

115 

116 

117 

118 

119 

120 

121 


Cl  =  2.09; 
c2  =  2.09; 
phi  =  cl+c2 ; 

ci  =  2/abs(2-phi  -  sqrt(phi''2  -  4*phi)); 

cc  =  cl*random( ’ unif *  ,  0 , 1) ; 
cs  =  c2*random( ’unif *  ,0 , 1) ; 


vdum  =  v( : , h) ; 

%update  velocity 

%  vdum  =  ci*(vdum  +  cc * (pbest ( : , h)  -  x(:,h))  + 

cs*(gbest  -  x(: ,h))) ; 

vdum  =  ci*(vdum  +  cc* (pbest (:, h)  -  xC:,h))  +  cs*Cgbest  -  x 
(: ,h))) ; 

%check  to  make  sure  velocity  doesn’t  exceed  max  velocity  for 
each 
%variable 
for  w  =  l:n 

%if  the  variable  velocity  is  less  than  the  min,  set  it 
to  the  min 
if  vdum(w)  <  -d(w) 
vdumCw)  =  -d(w) ; 

%if  the  variable  velocity  is  more  than  the  max,  set 
it  to  the  max 
elseif  vdum(w)  >  d(w) ; 
vdum(w)  =  d(w) ; 

end 
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end 


V ( : , h)  =  vdum ; 

%update  position 
xdum  =  x(:,h)  +  v(:,h); 

for  r  =  l:n 

%i£  particle  has  passed  lower  limit 
if  xdum(r)  <  llimCr) 
xdum(r)  =  llim(r) ; 

elseif  xdum(r)  >  ulim(r) 
xdum(r)  =  ulim(r) ; 

end 

X ( : , h)  =  xdum ; 


end 


end 


end 

%  round  variables  to  get  finite  precision 
for  aa  =  l:n 

X  (aa  ,  :  )  =  round  (x  (aa  ,  :)*10''(prec(aa)))/lO''precCaa)  ; 
v(aa  ,  :  )  =  round  (v(aa  ,  :)*10''(prec(aa)))/lQ''precCaa)  ; 

end 

pop_mat (k) . pop  =  x; 
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%% 


'Cost  Function 


for  m  =  1 : swarm 

MU  =  398600.5; 

^  *  *  *  *  *  *  **********  ^  Q  g  ^  function  evaluation  here 


opt_vars  =  X ( : , m) ; 

%  variable  definitions 

satellite  =  opt_vars(l); 
min_ind  =  opt_vars(2); 

C_times_c  =  DataStruct (satellite) . times ; 
C_ind_c  =  DataStruct (satellite) . ind ; 

Ri jk_c  =  DataStruct (satellite) .Rc; 

Vi jk_c  =  DataStruct (satellite) .Vc; 
rho_vec_cw_c  =  DataStruct (satellite) . rho_c ; 
Tvec_c  =  DataStruct (satellite) .Tc; 
max_ind  =  DataStruct (satellite) .max_ind; 

if  min_ind  >  max_ind 
J (m)  =  Inf ; 

else 


if  rep_mat (satellite , min_ind)  0 

J (m)  =  rep_mat (satellite , min_ind) ; 

x_inside ( : , m)  =  xrep (satellite , min_ind) . xinsidevals ; 

else 
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%Period  of  Chief  satellite’s  orbit 


Pc  =  2*pi ''sqrt  (a_chief_vec  (satellite)  "3/ MU)  ; 


t_enter  =  C_tiines_c  Cmin_ind  ,  1)  ; 
t_exit  =  C_times_c (min_ind , 2) ; 
t_zone  =  t_exit  -  t_enter; 

%determine  indices  of  minimum  duration  contact 
C_ind_contact  =  C_ind_c (min_ind , : ) ; 

%find  unit  vector  pointing  towards  the  deputy  that  puts 
chief  between 
%ground  site  and  deputy 

rho_unit_cw  =  rho_vec_cw_c ( : , C_ind_contact (1) : 
C_ind_contact (2) ) ; 

%determine  alpha  and  beta  angles  during  contact  times 
[alphavec ,betavec]  =  alphabeta Crho_unit_cw) ; 

%Vector  of  times  for  propogation 

T_prop  =  Tvec_c (C_ind_contact ( 1) : C_ind_contact (2) )  - 
Tvec_c (C_ind_contact (1) ) *ones (length CTvec_c ( 
C_ind_contact (1) : C_ind_contact (2) ))  ,1) ; 

%Determine  position/velocity  vectors  of  chief  satellite 
upon  intial/final 
%contact 

chief_pos0  =  Ri jk_c ( : , C_ind_c (min_ind , 1) ) ; 
chief_vel0  =  Vi jk_c ( : , C_ind_c (min_ind , 1) ) ; 
chief_posf  =  Ri jk_c ( : , C_ind_c (min_ind , 2) ) ; 
chief_velf  =  Vi jk_c ( : , C_ind_c (min_ind , 2) ) ; 
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if  min_ind  <  max_ind 

max_coast£  =  C_times_c (min_ind+l , 1)  -  C_times_c( 
min_ind  ,  2)  ; 

else 

max_coast£  =  DataStruct (satellite) . max_coastf ; 

end 

%tirae  variables  have  precision  to  .1  second.  Others 
have 

%precision  to  8.801  units  (km, rad) 
prec2  =  [2 ; 8 ; 3 ; 3 ; 8 : 2 ; 8 ; 6]  : 

x( : ,m) ; 

[J (m) , ~ , x_inside_dum , ~ , k_inside , "]  = 

PS0_REL_SHAD0W_DV4in£ (7 , [8  2*pi ; 1  C_times_c (min_ind 
,l);xmin  xmax ; xmin  xmax ; 1  max_coast£;8  2*pi  ;  1 
16*3688] , prec2 , 588 , 388 , chie£_pos8 , chie£_vel8 , 
chie£_pos£  ,  . . . 

chief_vel£ , dep_params , GEO_params , alphavec , betavec , 
t_zone  ,  Pc  ,  t_enter  ,  t_exit ,  r_cyl  ,  T_prop  ,  GMST8  , 
lat_site , long_site , t_step , el_val_shadow , kin£) ; 
if  k  ==  1  II  rep_mat (satellite , min_ind)  ==  8 
rep_mat (satellite , min_ind)  =  1 (m) ; 

xrep (satellite , min_ind) . xinsidevals  =  x_inside_dum ; 

else 

if  1 (m)  <  rep_mat (satellite , min_ind) 
rep_mat (satellite , min_ind)  =  3 (m) ; 

end 

end 
3  (m)  ; 
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x_inside ( : , m)  =  x_inside_dum ; 
out_loop  =  m; 
if  k  ==  1 

k_tot  =  k_inside; 

else 

k_tot  =  k_inside  +  k_tot; 

end 

end 


end 

end 


[mini , ind_minJ ]  =  min(J); 
x_inside ( : , ind_minJ ) ; 

*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  ******  c  o  n  s  t  r  a i n t  Equations 


%% 


%% 


if  k  ==  1 


Jpbest (1 : swarm)  =  l(l:swarm); 
pbest  (  :  , 1 : swarm)  =  x ( :  , 1 : swarm) ; 

[Jgbest,IND]  =  min ( Ipbest  (  : ) ) ; 

gbest  (:)  =  x(:  , IND) ; 
g_inside_best  =  x_inside ( : , IND) ; 
stall  =  0; 
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else 


for  h=l : swarm 

if  1(h)  <  Jpbest(h) 

Ipbest (h)  =  1  (h)  ; 
pbest(: ,h)  =  x(: ,h) ; 
if  Jpbest(h)  <  Jgbest 


Jgbest  =  Jpbest(h); 
gbest  (:)  =  x(:  ,h) ; 
g_inside_best  =  x_inside ( : , h) 


end 

end 

end 


end 

count  =  0; 

for  y  =  1 : swarm 

diff  =  Jgbest  -  Jpbest(y); 

if  abs(diff)<10''(-prec  (n+1)  +1) 
count  =  count+1; 

end 

end 

%round  cost  to  nearest  precision  required 
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2  =  round(J*l®''prec(n+l))/10''prec(n+l)  ; 
pop_mat (k) .3  -  2  ; 
pop_mat (k) . gbest  =  gbest; 

JG(k)  =  Jgbest ; 

JGmin  =  Jgbest ; 

if  k  >  1 

if  CJG(k)  -  JG(k-l))  ==  0 
stall  =  stall  +  1; 

else 

stall  =  0; 

end 

end 

if  count  ==  swarm 
break 

end 

if  stall  ==  stall_lim 
break 

end 

tend  =  toc(tstart); 

iter_complete  =  k 
iter_time  =  toe (t_inside) 
format  long  g 
gbest 

g_inside_best 

JGmin 

end 

gbest_tot (1 : n)  =  gbest; 
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327  gbest_tot  (n+1 :  n+lengthCg_inside_best)  )  =  g_inside_best ; 
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